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CHAPTER  I 


INTRODUCTION 

1.1  General  Background 

Locomotion  can  be  defined  as  the  process  of  movement  from  one 
place  to  another.  Throughout  recorded  history,  man  has  been  fascinated 
by  the  locomotion  of  various  types  of  animals  on  land,  under  water,  and 
in  the  air.  For  example,  drawings  of  various  animals  found  on  the  walls 
of  cave  dwellings  are  testimony  to  the  interest  that  prehistoric  civili¬ 
sations  had  in  the  locomotion  of  animals.  Locomotion  studies  were  made 
around  the  third  century  3.  C.  by  Aristotle  and  his  associates  [1].  In 
latter  periods  of  history,  specifically  during  the  eighteenth  and  nine¬ 
teenth  centuries,  doctors  and  scientists  both  in  Europe  and  America,  con¬ 
ducted  various  studies  dealing  with  different  aspects  of  legged  locomo¬ 
tion.  Some  of  the  topics  of  study  were:  1)  Anatomical  studies  to  deter¬ 
mine  the  center  of  gravity  of  the  human  body  [2-4],  2)  Studies  of  the 
types  of  muscles  that  came  into  play  during  walking  [2,5],  3)  Photogra¬ 
phic  etudies  of  human  and  animal  gaits  [6-8],  4)  The  kinematics  and 
dynamics  involved  in  human  locomotion  [9-12]. 

Recently,  with  the  emergence  of  the  field  of  Bioengineering, 
scientists  and  engineers  have  begun  to  take  «  fresh  look  it  the  instru¬ 
mentation,  the  diagnostic  techniques,  and  the  types  of  devices  used  by 
the  medical  profession  with  a  view  toward  their  improvement.  One 


1 


2 


of  the  areas  in  which  such  interdisplinary  research  is  being  conducted 
is  the  study  of  legged  locomotion  systems.  Hopefully,  the  development  of 
a  sound  mathematical  basis  for  legged  locomotion  systems  which  Includes 
system  dynamics,  should  lead  to  better  limb  coordination  control  schemes. 
Computer  Simulations  of  both  kinematic  and  dynamic  models  of  legged 
locomotion  systems  are  useful  in  the  design  and  development  of  better 
and  more  efficient  prosthetic  and  orthotic  devices,  as  well  as  in  the 
design  of  automatic  feedback  controllers  for  legged  vehicles. 

1.2  Objectives  and  Limitations  of  the  Dissertation 

The  objectives  of  this  dissertation  are  obtain  answers  to  some  of 
the  problems  concerned  with  the  dynamic  stability  and  limb  coordination 
control  of  legged  locomotion  systems.  The  techniques  of  vibrational 
analysis  are  used  to  obtain  stable  postural  control  of  legged  locomotion 
systems.  The  application  of  certain  stability  criteria  on  these  systems 
is  also  discussed.  Digital  computer  simulations  are  used  to  obtain 
dynamically  stable  gaits  for  idealized  models  of  human  and  animal 
locomotion. 

This  research  has  the  following  limitations: 

1)  The  models  investigated  consist  of  a  single  rigid  body 
supported  by  massless  legs. 

2)  The  type  of  control  used  in  the  simulations  presented  in  this 
dissertation  produces  "marching"  type  of  limb  coordination, 
that  is,  the  model  is  assumed  to  move  at  a  constant  velocity 
on  level  ground,  in  the  desired  direction  of  motion 
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placing  its  feet  regularly  at  specified  intervals  of  bot. 
time  and  space. 

Other  types  of  control  schemes  and  locomotion  systems  with  leg 
mass  are  aot  considered  in  this  dissertation. 

1.3  Organization  of  the  Dissertation 

Chapter  I  provides  a  brief  historical  introduction  to  the  general 
problem  of  legged  locomotion.  The  objectives  and  limitations  of  the 
dissertation  are  discussed  in  Section  1.2.  in  conclusion,  a  summary  of 
the  contents  of  each  chapter  is  given. 

Chapter  11  contains  a  short  survey  of  the  extensive  literature 
that  is  available  on  the  problem  of  legged  locomotion.  Specifically* 
this  chapter  breaks  down  the  general  study  of  legged  locomotion  systems 
in  terms  of:  1)  finite  state  models,  ?.)  kinematic  models.  3)  dynamic 
models. 

Chapter  III  presents  the  general  equations  of  motion  for  an 
n-legged  locomotion  system.  Also,  the  equations  of  motion  of  a  type  of 
inverted  pendulum  system  that  *s  used  in  this  dissertation  are  derived. 

Chapter  IV  provides  the  core  of  the  theoretical  considerations 
describing  the  method  of  postural  control  system  mode  analysis.  After 
discussing  the  theory  involved  in  the  mode  interpretation  of  free  motion 
of  legged  locomotion  systems,  the  small  angle  equations  of  motion  are 
derived  for  a  quadruped.  This  chapter  concludes  with  a  derivation  of 
the  linearized  equations  of  motion  of  the  inverted  pendulum  system 
discussed  in  Chapter  111. 

Chapter  V  gives  a  brief  insight  into  the  problem  of  determining  the 
eigenvalues  and  eigenvectors  of  rea] ,  non-symmetric,  square,  general 
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matrices.  The  chapter  concludes  with  a  discussion  of  the  application 
of  these  methods  for  obtaining  the  eigenvalues  and  eigenvectors  for  the 
various  modal  matrices  derived  in  Chapter  IV. 

Chapter  VI  is  devoted  to  the  problem  of  stability  and  control  of 
the  locomotion  systems  studied  in  this  dissertation.  The  type  of  con¬ 
trol  used  for  the  n-legged  locomotion  system,  namej./,  model  reference 
control  is  described.  Then,  the  necessary  and  sufficient  conditions  for 
the  small  motion  stability  of  the  quadruped  locomotion  system  are 
obtained  using  the  Routh-Hurvitz  criterion  on  the  linearized  equations 
of  motion  of  these  systems.  Finally,  in  Section  6.7  the  application  of 
these  stability  criteria  fov  obtaining  stable  biped  and  quadruped  gaits 
is  discussed. 

Chapter  VII  describes  the  results  of  computer  simulation  conduc¬ 
ted  during  the  course  of  this  research.  In  Section  7.2,  the  nonlinear 
quadruped  simulation  is  verified  by  the  application  of  vibrational  ana¬ 
lysis  to  the  quadruped  postural  system.  Computer  output  data  is  presen¬ 
ted  tc  show  correspondence  between  the  nonlinear  and  linearized  system 
responses  to  within  one  part  in  106.  Details  of  the  simulation  of 
quadruped  gaics  such  as  the  crawl,  the  walk,  and  the  trot  are  given  in 
Section  7,3.  Section  7.4  is  devoted  to  the  results  of  digital  computer 
simulation  of  an  inverted  pendulum  with  the  mass  pivoted  at  a  distance 
below  its  center  of  gravity  and  supported  by  a  massless  leg  with  a 
"fixed"  foot.  Both  the  transient  response,  as  well  as  the  results  of 
the  Routh-Hurwitz  analysis  are  presented  in  this  section.  Section  7.5 
covers  the  application  of  the  inverted  pendulum  stability  criteria  in 
the  development  of  the  simulation  of  a  stable  quadruped  pace  gait. 


Finally,  Section  7.6  discusses  a  type  of  biped  gait  simulated  in  the 
course  of  this  research. 

Chapter  VIII  summarizes  the  results  of  this  research,  and  out¬ 
lines  topics  for  further  research  in  the  area  of  legged  locomotion 
system  studies. 

Finally,  a  listing  of  the  computer  programs  with  explanations 
as  well  as  a  list  of  references  is  given  in  the  appendices. 


CHAPTER  II 


SURVEY  OF  PREVIOUS  WORK 


2.1  Introduction 

This  chapter  attempts  to  give  a  brief  overview  of  the  large 
amount  of  literature  that  is  available  in  the  area  of  legged  locomotion 
system  studies.  The  available  literature  comes  from  the  following 
areas  among  others:  biomechanics,  kinesiology,  prosthetics,  ortho tics, 
etc.  Some  aspects  of  the  general  problem  of  legged  locomotion  have 
been  mentioned  in  Section  1.1  which  gives  an  idea  of  the  historical 
development  of  this  area  of  research. 

The  study  of  legged  locomotion  systems  is  described  in  terms  of 
three  types  of  models,  1)  finite  state  models,  2)  kinematic  models,  and 
3)  dynamic  models.  Section  2.2  covers  the  theory  of  finite  state 
machines  as  applied  to  locomotion  systems  considering  a  leg  as  being  in 
one  of  two  states,  either  on  the  ground  (supporting  phase)  or  in  the 
air  (swing  phase) .  The  kinematic  aspects  of  locomotion  are  dismissed 
in  Section  2.3,  which  presents  the  work  being  done  in  the  area  of  time 
and  motion  studies  of  human  and  animal  gaits.  Section  2.4  surveys  the 
work  done  in  th .  modeling  of  legged  locomotion  systems  including  their 
system  dynamics. 

2.2  Finite  State  Models 

The  application  of  the  theory  of  finite  state  automata  to  legged 
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locomotion  systems  w<*s  first  suggested  by  Tomc.vic  and  Karplus  [13,14] . 
Based  on  their  work,  McGhee  [15]  developed  a  finite  state  theory  for 
legged  locomotion.  He  considered  each  leg  as  a  sequential  machine  with 
binary  output,  and  defined  a  number  of  basic  concepts  such  as  gait,  gait 
matrices,  duration  vector,  duty  factor,  etc.  Using  these  basic  defini¬ 
tions,  he  classified  gaits  into  regular  gaits,  symmetric  gaits,  connected 
gaits,  etc,  and  postulated  theorems  defining  their  properties.  This 
finite  state  theory  was  used  by  McGhee  and  Frank  [16]  to  develop  criteria 
for  selecting  optimum  gaits  for  low  speed  locomotion  of  an  idealized 
quadruped  system.  They  showed  that  the  optimum  gait  for  low  speed  loco¬ 
motion  of  an  idealized  quadruped  model  corresponds  to  the  crawl,  the  low 
speed  gait  preferred  by  most  natural  quadrupeds. 

To  test  the  validity  of  the  finite  state  theory  of  legged  locomo¬ 
tion,  a  small  artificial  quadruped  with  four  identical  legs,  each  with  a 
powered  hip  joint,  and  knee  joint  was  constructed  at  the  University  of 
Southern  California  [17].  A  small  special  purpose  digital  computer  was 
used  for  the  coo  dination  of  joint  motion  of  this  machine,  thus  proving 
that  automatic  limb  coordination  control  of  legged  locomotion  systems 
such  as  the  quadruped  could  be  achieved  by  simple  finite  state  algori¬ 
thms. 

Finite  state  control  of  legged  locomotion  systems  implies  that 
the  system  is  statically  stable  at  all  times.  Both  ’’synchronous”  and 
"asynchronous"  types  of  control  were  used  successfully  with  this  machine 
[18] .  However,  simple  finite  state  control  mechanisms  for  biped  locomo¬ 
tion  have  not  been  emonstrated  so  far. 


Recent  work  in  the  area  of  finite  state  aspects  of  locomotion 


8 


has  dealt  with  the  properties  of  regularly  realizable  gait  matrices. 

Jain  { 19  3 »  has  applied  the  techniques  of  linear  programming  for  determi¬ 
ning  the  number  of  regularly  realizable  nonsingular  gaits  for  bipeds  und 
quadrupeds.  He  found  that  out  of  the  5040  nonsingular  quadruped  gaits, 
there  were  a  total  of  480  regularly  realizable  nonsingular  gaits  which 
could  be  reduced  to  44  equivalence  classes.  At  least  11  of  these  **4 
equivalence  classes  of  regularly  realizable  gaits  were  found  to  be  the 
natural  gait  of  some  animal  from  the  work  of  Roberts  [20],  and  Hildebrand 
[21]. 

Legged  locomotion  systems  possess  a  large  number  of  degrees  of 
freedom,  and  are  by  nature  very  nonlinear.  The  development  of  a  finite 
state  theory  for  legged  locomotion  systqps  was  one  of  the  first  systema¬ 
tic  approaches  to  the  mathematical  analysis  of  these  complex  systems. 

This  study  has  been  a  natural  extension  of  the  work  of  earlier  investiga¬ 
tors  such  as,  Muybridge,  Roberts,  Hildebrand,  among  others  who  attempted 
to  classify  human  and  animal  locomotion  by  various  methods. 

2.3  Kinematic  Models 

This  section  reviews  work  done  in  the  area  of  kinematic  studies  of 
legged  locomotion  systems.  Typically,  research  in  this  area  involves 
the  study  of  human  and  animal  gaits  disregarding  the  forces  associated 
with  these  motions. 

Motion  and  time  studies  of  human  and  animal  locomotion  have  been 
made  by  man  throughout  recorded  history.  During  the  17th  century, 

Borelli  [22],  a  professor  of  mathematics  in  Naples,  Italy,  determined  the 
position  of  the  center  of  gravity  in  man  and  in  animals,  and  related  it 
to  the  locomotion  of  various  species.  He  drew  an  analogy  between  the 
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bones  and  levers,  and  the  muscles  and  the  forces  acting  on  *-hese 
levers. 

Marey  [23]  published  a  series  of  books  between  1873  and  1895. 

He  invented  a  pneunatic  method  of  registering  scientific  experiments  a 
short  di  *nce  away  from  where  the  evsnt  takes  place.  The  device 
called  Marey  Tambours,  consisted  of  two  lever  drums  connected  by  rubber 
tubing  to  the  subject.  For  studying  locomotion,  these  lever  druns  were 
used  for  recording  the  motion  of  various  parts  of  the  human  body. 

Marey  also  developed  the  chronophotographic  method  for  recording 
gait  [6J.  In  this  method,  successive  exposures  are  made  on  the  same 
photographic  plate  by  means  of  a  rotating  mechanism  inside  the  camera. 
The  subject  dressed  in  light  clothing,  walks  in  front  of  a  black  back¬ 
ground.  Braune  and  Fischer  [24],  used  a  variation  of  Marey's  method  to 
show  only  points  and  lines  on  the  photograph.  In  their  method,  called 
geometric  chronophotography,  the  subject  wa3  dressed  entirely  in  black 
with  brilliant  metal  buttons  or  shining  bands  attached  to  the  clothing 
to  mark  the  joints  and  bone  segments. 

Eadward  Muybridge  [25,26],  was  the  first  to  analyze  animal  and 
human  motion  by  photographic  studies  begun  in  1872.  His  work  consisted 
of  closely  spaced  sequential  photographs  of  animals  and  the  undraped 
human  form  in  motion,  Muybridge’s  work  resulted  in  two  books,  one  on 
animal  motion  [7],  and  the  other  on  huaan  locomotion  [8].  These  books 
are  considered  as  classics  on  the  photographic  analysis  of  the  gaits 
of  animals  and  huaan  beings. 

In  the  twentieth  century,  a  lot  of  research  has  been  conducted 
on  various  kinematic  aspects  of  locomotion.  An  excellent  chronological 
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literature  survey  of  locomotion  upto  1949  has  been  p,iven  by  Schermerhorn 
[27]. 

Kinematic  studies  of  locomotion  have  involved  such  topics,  making 
podograms  (recording  of  the  sequences  and  duration  of  weight-bearing  on 
three  points  of  the  bottom  of  the  foot)  [28],  investigations  of  the 
relationships  between  length  of  stride,  rate,  and  speed,  and  energy 
consumption  in  level  walking  [29],  electro-basographic  method  of  recor¬ 
ding  gait  [30],  studies  of  normal  and  abnormal  gait  patterns  [31],  etc. 

Very  recently,  engineers  and  scientists  have  begun  to  apply  the 
advances  in  technology  such  as  the  development  of  modern  control  theory, 
and  high  speed  digital  computers  to  the  analysis  of  the  kinematics  of 
legged  locomotion  systems. 

Chow  and  Jacobsen  [32],  have  studied  human  locomotion  by  methods 
of  optimal  programming  and  modem  control  theory.  Using  the  techniques 
of  optimal  control  theory,  they  analyzed  biped  locomotion  as  a  multi¬ 
point  boundary  value  problem.  They  were  able  to  simulate  curves  of  nip, 
knee,  and  ankle  movements  which  agreed  well  with  experimental  data. 

Hartrum  [33],  has  developed  a  computer  simulation  of  a  kinematic 
model  of  human  gait.  He  has  used  the  technique  of  classifying  gaits  by 
their  major  determinants  first  proposed  by  Saunders,  Inman,  and  Eberhart 
[10],  and  has  produced  a  computer  simulation  of  a  stick  figure  of  a  man 
whose  motion  is  determined  by  some  80  different  kinematic  parameters. 

Such  simulations  are  useful  In  synthesizing  gaits  to  suit  experimental 
data.  Also,  they  can  be  used  as  a  computer  aided  tool  to  demonstrate  both 
normal  and  pathological  gaits  to  doctors  and  physical  therapists. 
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Burnett  and  Johnsoi  [34],  have  studied  the  development  of  gait  in 
childhood.  They  used  sot 'in  pictures  of  gait  patterns  and  also  studied 
the  possibility  of  using  <  lectrogoniometry  as  a  diagnostic  aid  in  evalua¬ 
ting  early  abnormalities  children. 

The  research  topicf  mentioned  above  should  give  an  indication  of 
the  state-of-the-art  of  kinematic  studies  of  legged  locomotion  systems  at 
the  present  time. 

2.4  Dynamic  Models 

Many  researchers  have  studied  the  dynamics  of  legged  locomotion 
systems  from  various  angles.  Some  of  the  topics  of  research  involved 
investigations  such  as:  1)  experiments  to  determine  the  center  of  gravity 
of  the  hui^an  body  1 3 1 35 ] ,  :!)  studies  of  weight  bearing  on  the  foot  [36], 
3)  force-plate  method  of  measuring  the  pressure  that  the  foot  exerts 
against  the  ground  [37],  4)  studies  of  the  work  done  by  and  the  mechani¬ 
cal  efficiency  of  human  muscles  during  walking  [38,39],  etc. 

Many  such  research  efforts  were  qualitative  in  nature.  Fischsr 
[40],  tried  to  relate  data  taken  by  chronophotography  to  a  three  axes 
coordinate  system,  and  tried  to  determine  the  forces  lying  behind  the 
accelerations  and  velocities;  of  the  pathways  of  gait.  Using  calculus, 
he  analyzed  the  moving  forces  indirectly  from  pictures  by  establishing 
displacements,  velocities,  accelerations,  and  from  this,  the  muscular 
efforts  involved  in  walking. 

Elftman  [41-43],  published  many  articles  between  1934  and  1951  on 
sucv  topics  ns,  the  measurement  of  the  external  forces  in  walking,  the 
work  dime  >y  the  muscles  in  walking,  experimental  studies  on  the  dynamics 
of  human  walking,  etc.  Using  the  force-plate  in  conjunction 
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with  motion  pictures,  and  podograph  impressions,  he  tried  to  get  a 
total  picture  of  what  wa3  happening  to  the  foot  during  each  phase  of  the 
stance.  He  also  used  graphical  differentiation  as  a  means  for  the 
determination  of  the  external  forces  acting  on  the  body  from  its  dis¬ 
placements*  Elftman  also  computed  the  energy  transferred  and  the  rate 
of  work  being  done  by  the  various  components  of  the  locomotion  system. 

In  an  article  published  in  1938,  Master  [44] s  discussed  the 
dynamics  of  quadruped  walking.  He  recorded  the  external  forces  applied 
to  the  feet  of  cats  as  they  walked  over  a  special  measuring  platform, 
and  determined  the  components  of  the  acceleration  of  their  center  of 
gravity  in  a  three  axes  coordinate  system.  Master  also  discussed  his 
results  with  those  obtained  by  graphical  differentiation,  and  showed 
that  his  method  involved  fewer  approximations. 

Gage  [11],  has  discussed  the  accelerographir.  analysis  of  human 
gait.  He  used  strain  gage  accelerometers  mounted  on  subjects  at  the 
level  of  the  secodd  sacral  vertebra  to  measure  both  linear  and  angular 
accelerations.  Studies  were  conducted  on  amputees  as  well  as  nun- 
amputees,  and  a  comparison  made  between  their  accelerograms  during  slow 
and  -  ormal  level  walking,  ramp  descent,  ana  stair  descent.  Gage  used 
harmonic  analysis  to  correlate  gait  defects  with  abnormalities  in  the 
individual’s  frequency  spectrum. 

From  the  enureex'ation  of  the  various  research  activities  in  the 
area  of  the  dynamic  analysis  of  legged  locomotion  systens,  one  can  see 
that  many  previous  studies  were  qualitative  in  nature.  Both  human  and 
animal  locomotion  is  th  ''’.suit  of  complex  processes  involving  many 
factors.  However,  one  can  get  an  idea  of  the  dynamics  involved  in  the 
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process  of  legged  locomotion  by  considering  simple  models  for  such 
systems.  According  to  Beyliss  [45],  “A  standing  animal  is  like  a  box 
balanced  on  four  walking-sticks,  each  jointed  in  the  middle;  to  repre¬ 
sent  a  man,  the  box  is  up-ended  and  balanced  on  two  3uch  jointed  sides". 

Becently,  research  efforts  have  been  directed  towards  the  devel¬ 
opment  of  a  sound  mathematical  basis  for  the  dynamics  of  legged  loco¬ 
motion  systems  [46],  Frank  and  McGhee  [47],  have  derived  the  equations 
of  motion  for  a  four  legged  locomotion  system  consisting  of  a  single 
rigid  body  supported  by  massless  legs.  This  dvnamic  model  was  assumed  to 
"march’"  with  a  constant  velocity  in  the  direction  of  motion,  on  level 
grounds 

With  the  advent  of  high  speed  computers,  and  the  newer  techniques 
of  modern  control  theory,  legged  locomotion  systems  can  now  be  simulated 
so  that  their  system  dynamics  can  be  displayed  in  real  time.  The  present 
research  uses  the  techniques  of  vibrational  analysis  to  obtain  postural 
control  for  the  quadruped  locomotion  system  of  Frank  and  McGhee  t47] . 

In  addition,  such  modal  analysis  is  used  to  validate  the  non-linear  equa¬ 
tions  of  motion  describing  the  system  by  exposing  any  mistakes  in  the 
derivation. 

Alsv ,  this  research  effort  is  directed  toward  the  determination 
of  stability  criteria  for  quadruped  locorction  systems  and  a  type  of 
inverted  pendulum  system.  In  addition,  inverted  pendulum  analysis  is 
used  for  the  stability  of  both  the  quadruped  and  biped  systems,  and  to 
simulate  certain  dynamically  stable  quadruped  and  biped  gaits. 
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2.5  Summary 

This  chapter  has  sketched  briefly  the  developments  that  have 
taken  place  in  the  area  of  analysis  of  legged  locomotion  ays terns.  The 
general  problem  of  simulation  of  legged  locomotion  systems  has  been 
outlined  in  terms  of  three  specific  areas ,  namely,  finite  state  models, 
kinematic  models,  and  dynamic  models.  Sections  2.2  and  2.3  have 
presented  work  done  upto  the  present  time,  in  the  areas  of  finite  state 
modelitig>  and  kinematic  system  modeling  of  locomotion  systems.  Section 
2.4  has  surveyed  the  past  research  efforts  in  the  analysis  of  the 
dynamic  aspects  of  locomotion  systems.  In  addition,  this  section  has 
related  the  present  research  effort  to  the  previous  work  in  this  area. 
This  literature  survey  is  by  no  means  an  exhaustive  enumeration  of  the 
vast  amount  of  literature  available  in  the  area  of  legged  locomotion 
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CHAPTER  III 

EQUATIONS  OF  MOTION  OF  LEGGED  LOCOMOTION  SYSTEMS 

3 . 1  Introduction 

The  objective  of  this  chapter  is  to  describe  the  dynamics 
associated  with  the  motion  of  legged  locomotion  systems.  In  order  to 
do  this,  in  Section  3.2,  the  general  equations  for  the  translational 
and  rotational  motion  of  a  rigid  body  are  first  derived  [ 48J  *  These 
basic  equations  of  motion  for  a  rigid  body  are  then  applied  to  an 
idealized  legged  locomotion  system  consisting  of  a  body  of  mass  m  sup- 
ported  by  four  massless  legs  in  Section  2.3  [47].  Finally,  the  theory 
of  a  general  inverted  pendulum  system  is  described  in  Section  3.4, 

The  equations  of  motion  of  such  an  inverted  pendulum  system  consisting 
of  a  mass  pivoted  below  its  ceater  of  gravity  [50],  will  have  applica¬ 
tions  to  the  type  of  biped  locomotion  system  considered  in  this 
dissertation  as  well  as  in  the  stabilization  of  acme  faster  quadruped 
gaits  such  as  the  trot  and  the  pace. 

3.2  General  Equations  of  Motion  of  a  Rigid  Body 

In  general,  the  motion  of  a  rigid  body  can  be  described  by  a 
translational  equation  and  a  rotational  equation.  Considering  the 
general  motion  of  a  rigid  body,  and  choosing  the  center  of  mass  of  the 
body  as  the  reference  point,  if  the  total  external  force  acting  on  the 
body  is  independent  of  rotational  »etion,  and  if  the  external  moment  is 
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independent  of  the  motion  of  the  center  of  mass,  then  the  translational 
and  rotational  equations  of  motion  of  the  body  can  be  solved  separately. 

Consider  a  rigid  body  with  a  set  of  body  fixed  coordinate  axes 
along  the  principal  axes  of  the  body  having  its  origin  at  the  center  of 
mass.  The  general  rotational  equations  of  motion  of  such  a  rigid  body, 
aJso  called  the  Euler’s  equations  of  motion,  are  given  by  [48] 
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M  is  the  external  moment  acting  on  the  rigid  body,  w  ia  the 
absolute  angular  velocity  of  the  rigid  body,  and  1^,  Iyy,  and  Izz  are 
the  moments  of  inertia  of  the  body  about  the  x,  y,  and  a  axes  respec¬ 
tively. 

The  general  translationai.  equations  of  motion  of  a  rigid  body  of 
mass  m  are  given  by  [48] 
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v  -  vxi  +  vyj  +  v2k  (3-10) 

In  the  above  equations,  _F  is  the  total  external  force  acting  on 
the  rigid  body,  v  is  the  absolute  velocity  of  the  center  of  mass  of  the 
body,  bcth  being  expressed  interras  of  their  instantaneous  body  axis 
components. 

Equations  (3-1)  through  (3-5),  and  (3-6)  through  (3-10)  describe 
the  rotational  and  translational  motion  of  a  rigid  body  of  mass  ra  having 
a  system  body  fixed  coordinate  axes  with  its  origin  at  the  center  of 
mass  and  oriented  along  the  directions  of  the  principal  axes  of  the 
rigid  body. 

3.3  Equations  of  Motion  of  a  Quadruped  Locomotion  System 
3.3.1  Basic  Equations 

This  section  discusses  the  theory  dealing  with  the  equations  of 
motion  for  a  four  legged  locomotion  system.  It  is  to  be  noted  that  the 
derivations  of  equations  (3-11)  through  (3-40),  and  (3-50)  through 
v3-60)  are  from  reference  [47],  These  results  are  given  here  for  the 
sake  of  completeness  because  they  are  used  extensively  in  the  lineariza¬ 
tion  techniques  described  in  Chapter  IV.  Also,  equation  (A-29)  of 
reference  [47]  i3  not  correct,  and  the  correct  version  of  this  result  is 
given  by  equations  (3-46)  through  (3-49).  The  quadruped  locomotion 
system  considered  in  this  section  is  assumed  to  consist  of  a  body  of 
mass  m  supported  by  legs  of  negligible  mass. 

The  following  convention  has  been  assumed  for  the  coordinate 
axes.  The  Xg  coordinate  axis  is  directed  toward  the  desired  direction 
of  travel,  the  Zg  coordinate  axis  is  in  the  direction  of  gravitational 
acceleration  (positive  downward) ,  and  the  yg  axis  is  in  the  direction 
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of  the  vector  cross  product 

j£  =•  itg  x  i£  (3-11) 

The  equations  rf  motion  are  defined  with  respect  to  a  flat,  non- 

AAA 

rotating  earth,  so  that  ig,  jg,  kg  are  regarded  as  the  unit  vectors 
defining  an  earth  fixed  frame. 

The  total  state  of  the  locomotion  system  is  described  by  the 
twelve  element  body  state  vector 

x  *  (Xg,  y£,  Zg,  u,  v,  v,  6,  $,  ij>,  p,  q,  r)  (3-12) 

where 

Xg,  yg,  Zg  =■  position  of  the  center  '  gravity  of  the 

system  relative  to  an  inertial  frame  ig,  j£,  kg 

u,  v,  w  «  components  of  the  translational  velocity  of 
the  center  of  gravity  expressed  in  body 
coordinates 

9,  $,  \l>  *  the  body  Euler  angles 

p,  q,  r  *  body  rotation  rates  expressed  in  body  coordi¬ 
nates 

The  body  Euler  angles  are  unambiguously  defined  in  the  following 
manner.  A  r-ght  handed  body  fixed  coordinate  system  with  unit  vectors 
i,  j,  k  is  established  with  its  origin  fixed  at  the  center  of  gravity 
of  the  model.  This  body  fixed  coordinate  system  is  defined  such  that 
when  the  body  angles  0,  $,  ♦  are  all  simultaneously  reduced  to  zero,  the 

AAA  AAA 

i,  i,  and  k  axes  are  parallel  to  the  ig,  jg,  kg  axes  of  the  earth  fixed 
frame  respectively.  The  x,  y,  z  coordinates  are  measured  relative  to 

AAA 

the  body  fixed  coordinate  system  i,  j,  k  (see  Figure  1). 

Let  the  rotation  from  the  earth  fixed  (xg,  yE,  Zg)  system  to  the 
body  fixed  system  (x,  y,  z)  be  accomplished  by  first  rotating  about  the 

A  A 

kg  axis  (azimuth) ,  then  about  the  rotated  jg  axiu  (elevation) ,  and 
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finally  about  the  i  axis  (roll).  Then,  for  any  arbitrary  point  (xfl,  yfl. 


z  )  in  the  earth  fixed  system,  the  corresponding  coordinates  in  the 
body  fixed  coordinate  system  arc 
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For  the  locomotion  system  under  consideration,  if  Jf  is  the  vector 


of  applied  forces  expressed  in  body  coordinates 


f  «  <fx,  fy»  f2)‘  (3-15> 

and  T  is  the  vector  of  applied  torques  in  the  same  reference  frame 

T  -  (L,  M,  N)T  (3-1 

and  if  p,  q,  r  are  the  components  of  body  rotation  rate  measured  about 
the  body  fixed  x,  y,  z  system  cf  axes,  then,  the  Euler’s  equations  of 
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motion  for  this  particular  system  become 
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If  u,  v,  v  are  *-he  components  of  body  translational  velocity  in 
the  x,  y,  7,  system,  then,  from  equations  (3-6)  through  (3-8),  the  three 
translational  equations  of  motion  for  the  locomotion  system  are  given  by 


where  the  transformation  T2  is  given  by  [4S] 
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T 


2 


0  cos$  -sin<{> 

1  tan6sin4>  tan6cos$ 
0  sec9sin$  sec9eos$ 


(3-311 


Integration  of  equations  (3-29)  and  (3-30)  gives  the  desired 
position  components  of  the  body  state  vector  x. 

3.3.2  Leg  Lengths  and  Angles 

The  values  of  leg  lengths  and  angles  and  their  derivatives  are 
necessary  for  the  feedback  control  of  the  quadruped  locomotion  system. 
They  are  determined  as  follows. 

Let  the  position  in  body  coordinates  of  the  foot  of  leg  i,  i  *  1, 
2,  3,  4  be  given  by  the  vector  (x^  y^t  and  let  ^xiE»  yiE>  ziE)T 

be  the  predetermined  time-dependent  position  of  foot  i  in  the  earth 
fixed  system,  then 
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iE  E 

(3-32) 


The  other  end  of  the  leg  is  connected  to  the  body  at  the  corres¬ 
ponding  hip  socket.  Let  the  cooridnates  of  the  hip  socket  for  leg  i  in 
the  body  fixed  coordinate  system  be  given  by 

Hi  -  <v  V  ct>T  (3'33) 

The  leg  length,  and  leg  hip  angles  are  then  obtained  by  expressing  the 
vector 
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J 


d,  ** 


(3-34) 
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The  derivatives  of  foot  position  j  ,  and  appearing  in  the 
above  equations  are  obtained  by  differentiating  equation  (3-32)  as 
follows 


XiF  ~  XE 


r4  .*1 


Z'J  r-  "*  2- 


*1  j  ’  dT  |  '*1E  +  T1  fiE  -  *S 

Mi  |  ZiE  -  ZE  'iE  "  *2  j 

L  w*  L.  J  L  J 


(3-41) 


Therefore 


[XiE  Xe] 


yi  !  *  IF"  1  yiE  '  yE  |+T1  *iE  j 

Si  l>  *eJ  N 


VTIr 


(3-42) 


Since  T^*T^  *  [I],  the.  identity  matrix,  and  y^j.,  z^E  are 

•  •  » 

constants,  therefore,  x^E,  y^„,  ziE  are  zero* 

Hence 


dTl  ( 


XiE  XE 


dr  yiE"-yE  V 


■J  n 


siE  2 


(3-43) 


where  dT^/dt  **  the  derivative  of  matrix  given  in  equation  (3-14). 
For  convenience  define  ms.rix  T1  as  follows 
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T112 

T113 

121 

T122 

T123 

131 

''132 

T133 

(3-44) 


where  T^^  is  defined  by  equation  (3-14) . 

Then  the  derivative  of  the  transformation  matrix  becomes 


"**  •  *  * 
(-dsinecos’l—  ^T-j,^) 

•  • 
(-esinQsin^^T^^-) ) 

• 

-6cosS 

(6sin4»Till-r4)T13i-v)T;L22) 

<«sm»Tn2+;i1324T121 

•  • 

(-3sin0sin4>+({i'f^33) 

(dcos^i^-j  32^ 

mat 

(0cos*Tii2-^T122^T121) 

•  • 

(-fts  in0  ccs  <}>~<j>T^2  3) 

(3-45) 

Finally,,  from  equations  (3- 43>  and  (3-45),  the  derivatives  of 
foot  position  y^,  z ate  given  by 
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(3-46) 


where 


A=>  f  -  (  6  s  i  n  3  cosi|rN»T  (xj^Xg)~(6sin8sin(Ji-i{>Tjj^)  (y^  ^-yj,)-0cos3(2^;.-Zj.)-uj 

(3-47) 

B=[  <9sin<(iX1]L1-4T131-^T122)  (xiF~XE)  f  (e8in9T112+4f'132+^T121)  (y1F-yR)~ 

(9sin6sin4(-<{>T132'  (3-48) 

C-[;coS*Ilir;i12,4lX32)(x1E-xE)-f<hoS«Iu24l12j+*T131Hylr-yE)-. 

•  • 

(8sin6cosd+-£T32-j/  (z^-r^-w]  (3-49) 


3*3.3.  Control  Moments  and  Forces 

The  following  assumptions  are  made  for  the  type  of  control  law 
considered  for  the  locomotion  system: 


a)  It  is  assumed  that  each  foot  is  placed  on  the  ground  at  a 
sequence  of  pre-computed  --“Jitions  determined  prior  to  the 
start  of  forward  motion.  These  foot  placements  are  evenly 
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spaced  along  Che  desired  direction  of  travel  and  separated 
by  one  stride  length  for  any  given  foot. 

b)  The  length  of  each  leg  measured  from  its  hip  joint  to  its 
fc-ot  is  allowed  to  vary  through  knee  flexure. 

c)  I  he  force  applied  by  the  leg  to  the  body  along  &  line  joining 
the  foot  and  the  hip  joint  is  assumed  to  be  a  linear 
combination  of  leg  length  and  leg  length  rate.  Tnis  means 
that  each  knee  joint  ha3  a  rotational  spring  and  dawe-er- 

d)  Lateral  leg  deflects.  -»  is  assumed  to  be  controlled  by  a 
centering  spring  and  damper. 

e)  The  rearward  rotation  of  each  leg  is  controlled  by  applying  a 
torque  at  the  hip  proportional  fco  the  difference  between  the 
actual  angle  measured  from  the  body  axis  of  the  locomotion 
system  to  a  line  passing  through  the  foot  and  the  hip  socket 
and  the  desired  angle  computed  for  an  ideal  constant  velocity 
gait.  Error  rate  damping  is  also  included  in  t  •  computation 
of  each  hip  control  torque. 

Therefore  the  simulated  locomotion  sysrem  is  controlled  by 
applying  forces  along  each  leg  and  by  moments  applied  at  each  hip.  J.t 
is  assumed  that  the  momants  are  applied  about  the  y  body  axis  by  a  hip 
drive  motor  and  about  a  lateral  deflection  gimbal  axis  by  a  centering 
spring  and  damper. 

Considering  the  body  fixed  coordinate  system*  if  Tmi  is  the 
torque  applied  to  the  body  by  the  hip  motor  of  leg  i ,  Ts^  is  the 
centering  spring  torque  applied  to  the  bodj't  and  is  the  total  torque 
applied  to  the  body  by  leg  i,  then 
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that 
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Tn±  "  fxi£lco8&i 


0-5  A) 


and  the  centering  spring  torque  balance  implies  that 


0-55) 


Therefores  if  is  the  total  force  applied  by  Jec  i  to  the  body 
at  hip  socket  i,  expressed  i  leg  coordinates  *  then 


u 


^i 


(3-56) 


Finally,  the  total  leg  force  in  body  coordinates  is  given  by 


f.  »  T?f!  *  (f  ,  f  ,  f  )T  (3-57) 

-i  3-i  xt*  yi*  2± 

3.3.4  Total  Forces  and  foments  Applied  to  the  Body 

The  total  force  components  needed  in  equations  (3-23)  through 
(3-25)  are  obtained  by  sisnraation  over  all  leg  forces.  Therefore 
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(3-58) 


The  total  moment  vector  T_  given  by  equation  (3-16)  is  composed 
of  the  moments  applied  by  each  hip  motor  and  spring  and  the  moments  due 
to  forces  applied  at  each  socket  t^.  Therefore 
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where 
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(3-59) 


(3-60) 


The  equations  derived  above  [47]  are  used  to  determine  the  body 
state  vector  jc  from  its  initial  value  and  subsequently  applied  control 
torques  and  forces. 


3.4  Equations  of  Motion  for  an  Inverted  Pendulum  System 

A  simple  biped  locomotion  system  can  be  considered  to  be  a  mass 
with  two  massless  legs  attached  as  shown  in  Figure  2(a).  Figure  2(b) 
shows  the  model  with  the  torques  applied  about  the  hip  and  ankle  joints 
in  a  longitudinal  plane. 


Figure  2  A  Simple  Biped  Locomotion  System. 
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Figure  2(c)  shows  a  torque  applied  in  a  lateral  plane  to  keep  the 
body  from  falling  when  the  system  is  being  supported  by  one  of  the  legs. 
From  these  figures,  one  can  see  that  the  stabilization  of  the  biped 
system  is  similar  in  some  respects  to  the  inverted  pendulum  problem. 

In  analyzing  this  problem,  two  methods  of  approach  arc  possible: 
1)  the  application  of  Newton's  laws  of  motion,  and  2)  the  Lagrangian 
formulation  [49].  For  dynamic  systems  with  certain  constraints,  the 
Lagrangian  formulation  provides  an  easier  method  for  obtaining  their 
equations  of  motion.  The  inverted  pendulum  system  under  consideration 
has  a  kinematic  constraint  in  that  its  leg  length  I  is  fixed.  For 
this  reason,  the  equations  of  motion  of  this  system  are  derived  below 
by  the  application  of  Lagrange's  equations. 

In  analyzing  the  motion  of  a  system  by  the  Lagrangian.  approach, 
the  first  step  is  to  choose  a  set  of  Independent  coordinate^  «i.  J. 
completely  characterize  the  motion  of  the  system  without  any  red  ta.  ««*■.' 
The  kinetic  and  potential  energies  T  and  V  respectively  are  'hen 
computed  as  functions  of  the  q^s  and  q^'3. 

The  Lagrangian  function  L  is  given  by 

L  -  (T  -  V)  (3-61) 

and  the  equations  of  motion  of  the  system  are  given  by  the  Lagrange's 
equations 

-  Q.  i  -  l»2t3,4, , . . ,  n  (3-62) 

where  the  Q^'s  are  nonconservative  forces  applied  to  the  body.  These 
q^’s  are  calculated  by  producing  a  virtual  displacement  of  the  system 
and  finding  the  virtual  work  done  by  the  forces  Qj  as  given  by 


5W  “  l  ( 3—6  3) 

The  Lag rang! an  approach  is  now  applied  to  the  following  inverted 
pendulum  system.  Figure  3  shows  cn  inverted  pendulum  with  a  mass  m 
supported  by  a  mass; esc  leg  0f  fixed  length  •.  The  body  has  a  aoment 
of  ^ertia  I  and  its  center  o£  gravity  is  at  a  distance  r  above  the  hip 
joint.  The  leg  is  supported  by  a  '*  fixed  "  foot,  that  is,  the  foot  is 
attacneo  to  the  ground  by  a  frictionless  hinge  which  permits  rotation 
of  the  leg  in  a  plane  without  ar.y  translation  [50],  The  analysis  of  the 
inverted  pendulum  with  the  mass  pivoted  at  its  center  of  gravity  can  be 
found  in  reference  [51], 


y 


Figure  3  An  Inverted  Pendulum  System. 

Angles  ^  and  are  the  two  independent  coordinates  used  in  the 
Lcgrangian  formulation  of  the  equations  of  motion  for  this  system.  From 
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Figure  3  the  total  kinetic  energy  of  the  system  is  seen  to  be 


I  -  M|J|2  +  1  1% 


(3-64) 


and 

A  A 

h  »  -Usin^  +  rsin$2)i  +  (fccos^  4-  rcos$2) j  (3-65) 

A  A 

where  i,  j  are  the  unit  vectors  of  the  coordinate  system  shown  in  the 
figure  above. 

From  equations  (3-64)  and  (3-65),  the  expression  for  the  kinetic 


'<• » *0 bccctuCs 


T  =*  j  tu£ £2J|  4-  2£r$14»2cos($1-^2)  4-  r2*2]  +  J  I$2  (3-66) 


The  potential  energy  is  given  by 


V  *  mg(R-j)  «  mg(icos$^  4-  rcos^) 


(3-67) 


Therefore  the  Lagrangian  Sanction  L  is  given  by 

1  •  «  •  .  *2 

L  =  (T-V)  **  ^  iu[®-2(b|42tr(J)1^2cos(^^~^2)+r^<f,2^+ "J^2~mg^cos^l"’n’^rcos^2 

(3-68) 

The  virtual  work  done  is  given  by 

SK  -  M(S«j>7  -  64*^  (3-69) 

and  therefore  from  equations  (3-63)  and  (3-69) 

Q  *  -  M  (3-70) 

Q  *  4  M  (3-71) 

Solution  of  the  Lagrange’s  equations  (3-62)  gives  the  following 
equations  of  motion  in  the  independent  variables  $  and  ^ 
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2**  *  *  *2 

mi  ’^1-hn£r^2cos(4i1-4i2)+mAr<J2sin(^1-4i2)-mgjosiR«j!1  *  -  M  (3-72) 

(I+mr2)  4,'2+mAr^}cos(^1-(>i2)-n£r^sln<4i1-^2)“mgrsin4i2«  +  M  (3-73) 

The  above  equations  of  motion  can  be  rewritten  in  terms  of  state 
variables  by  using  the  following  definitions.  Let 


X1 

"  *1 

(3-74) 

X2 

*  ♦, 
dm 

(3-75) 

X3 

“  *1" 

(3-76) 

\ 

“  *2m  X2 

(3-77) 

Substitution  of  the  above  equations  into  equations  (3-72)  and 
(3-73)  gives  the  system  equations 
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m  x 

X3 

(3-78) 

x2 

=  x4 

(3-79) 
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x. 
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(3-81) 
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(AD  -  F) 
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*  mi 

(3-82) 
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»  mtr 

(3-93) 

C 

=  mgi 

(3-84) 

D 

■  (I  +  mr2) 

(3-85) 

E 

»  mgr 

(3-86) 

F 

*  Bcos(x1  -  x2) 

(3-87) 

G 

2 

*  [Esinx2  -  Bx3sin(xj  -  x2)  +  K] 

(3-88) 

H 

2 

■  [CsinXj  -  Bx4sin(Xj  -  x?)  -  M] 

(3-89) 
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Equations  (3-78)  through  (3-81)  given  above  provide  a  state 
variable  representation  of  the  equations  of  motion  of  tie.  inverted 
pendulum  system  with  a  "  fixed  "  foot. 

3.5  Summary 

In  this  chapter,  using  the  Newtonian  approach,  the  equations  of 
motion  of  a  general  quadruped  locomotion  »ystem  consisting  of  a  body  of 
mass  m  supported  by  massless  legt.  have  been  derived. 

Also,  the  equations  of  motion  for  a  type  of  inverted  pendulum 
system  with  a  "  fixed  ’*  foot  have  been  obtained.  These  basic  equations 
of  motion  will  be  used  in  the  rest  of  the  dissertation  to  simulate  pos¬ 
tural  control  systems  and  to  derive  stable  feedback  control  laws  for 
various  quadruped  gaits  as  well  as  for  a  certain  type  of  biped  loco¬ 


motion  system 
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POSTURAL  CONTROL  SYSTEM  MODE  ANALYSIS 

4.1  Introduction 

From  the  results  of  the  last  chapter,  the  equations  of  motion  of 
legged  locomotion  systems  are  seen  to  be  nonlinear  in  nature.  These 
equations  have  been  programmed  into  a  digital  computer  simulation  which 
produces  computer  generated  displays  of  the  idealized  locomotion  system 
performing  various  gaits. 

Now,  if.  is  well  known  in  classical  mechanics  that  conservative 
dynamic  systems  can  be  studied  in  terms  of  small  vibrations  about  an 
equilibrium  point  [48],  The  equations  of  motion  of  these  systems  rre 
linearized,  and  any  free  motion  of  these  systems  can  then  be  expressed 
as  a  superposition  of  "  normal  "  modes  of  vibration.  Each  "  normal  " 
mode  of  vibration  is  sinusoidal  and  is  characterized  by  its  frequency. 
This  concept  of  modes  of  free  motion  can  be  extended  to  any  linear 
time-invariant  differential  system,  even  if  the  system  is  non-conserva¬ 
tive  [52] . 

One  way  to  obtain  a  linearization  of  a  nonlinear  differential 
equation  of  the  form  x  *  f(x),  is  to  replace  f(x_)  with  a  truncated 
Taylor  series  expension  about  an  equilibrium  point  in  which  only  the 
linear  terms  are  retained.  A  theorem  can  be  proved  [53] ,  which  states 
that  under  certain  fairly  mild  conditions  cn  f(x),  such  a  Jacobian 
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linearization  [34]  yields  valid  information  regarding  the  stability  and 
damping  of  the  small  disturbance  motion  of  the  nonlinear  system* 

Rather  than  proving  that  the  conditions  of  this  theorem  are 
satisfied,  in  this  dissertation  the  time  domain  response  of  the  linear¬ 
ized  system  equations  are  compared  to  a  numerical  solution  of  the  non¬ 
linear  system  differential  equations  for  each  vibrational  mode.  It  will 
be  seen  in  Chapte  uhat  the  results  obtained  by  these  two  methods 

agree  to  better  v.han  one  part  in  ID6  thereby  validating  both  the  linear¬ 
ization  technique  and  both  computer  programs. 

In  line  with  the  above  objective,  this  chapter  first  deals  with  a 
description  of  linear  system  theory  emphasising  the  mode  interpretation 
of  the  "  free  motion  "  of  linear  time-invariant  systems. 

Then,  assuming  that  the  quadruped  locomotion  system  is  in  equili¬ 
brium  in  the  postural  position  with  its  feet  vertically  below  their  res¬ 
pective  hip  socket  positions,  the  linearized  equations  of  motion  are 
derived  using  small  angle  approximations,  both  by  rigorous  analysis  as 
well  as  by  an  intuitive  approach.  It  is  shown  that  the  rigorous 
approach  yields  a  12  x  12  system  matrix  which  decomposes  into  four 
smaller  matrices,  thus  giving  four  vibrational  systems  for  small  displa¬ 
cements  about  the  equilibrium  position. 

Finally,  in  Section  4.5  the  equations  of  motion  of  the  inverted 
pendulum  system  derived  in  Chapter  III  are  linearized  and  the  correspon¬ 
ding  system  matrix  is  obtained.  These  results  are  needed  uo  compute 
stabilizing  control  constants  for  the  legged  locomotion  systems  v.y  tha 
application  of  the  Routh-Hurwitz  stability  criterion  and  also  to  obtain 
the  eigenvalues  and  eigenvectors  o I  the  system  matrices  in  order  to 
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compute  their  linear  system  response. 

4.2  Mode  Interpretation  of  the  Free  Motion  of  Linear  Time- 
Invariant  System 

This  section  outlines  briefly  the  theory  of  "  free  motion  "  of 
a  general  linear  time-invariant  system.  The  results  of  this  section 
will  be  uacil  to  compute  the  linearised  system  response  of  the  legged 
locomotion  systems  discussed  in  this  dissertation.  Consider  a  general 
linear  time-invariant  system  described  by  the  state  equation 

jc(t)  *  Ax(t)  +  bu(t)  (4-1) 

where 

A  “  n  x  n  constant  matrix 

b  *  n  x  m  constant  matrix 

x(t)  *  n  rowed  column  vector  representing 
the  state  of  the  system  at  time  t 

x.(0)  «  ini  -  1  state  of  the  system  at  t  »  0 

u(t)  *  inpu_  m  vector 

Considering  "  free  motion  "  of  the  system,  the  input  vector  _u(t) 
is  zero  for  all  time  t.  a.-"  the  system  stute  equation  reduces  to  the 
form 

i(t)  ■  Ax(t)  (4-2) 

Consider  the  general  case  in  which  X  ,  i  1.  23,  ...  n  are  the 
r.  distinct  eigenvalues  of  the  matrix  A.  Any  no?.-zero  vector  such 
that  [55] 

Au  =  X  .u,  <u. ^  u.a  =1  i  =  1,  ...  n  (4-3) 

~ i  i— i  — 1  —1 
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is  called  an  eigenvector  associated  with  the  eigenvalue  Since  the 

eigenvalues  of  matrix  A  are  assumed  to  be  distinct,  their  associated 
eigenvectors  are  linearly  independent.  Therefore,  the  free  motion  x(t) 
can  be  uniquely  expressed  as  a  linear  combination  of  these  n  distinct 
eigenvectors  cf  matrix  A. 


x(t)  *  Re  l 
i«l 


•»<£<» 


(4-4) 


The  general  form  of  a^(t)  is  given  by 


a^{t)  =  C^e*it  (4-5) 

where  the  C_,'s  are.  constants. 


Therefore 


x(t)  •  Re  ][  (4-b) 

i*l 


At  t  *»  0,  equation  (4-6)  yields 


n 

x(0)  «  Re  £  C^u,  (4-7) 

i-1 

The  constants  can  be  found  by  using  the  reciprocal  basis  x_ 
defined  by  the  scalar  product 


KLi>  V  “  6ij 

(i,  j  -  1,  ...  n) 

(4-8) 

where  Kronecker  delta  ■  1 

for 

1  *  j 

=  0 

for 

i  *  j 
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Taking  the  scalar  product  of  r^  with  both  sides  of  equation  (4-7) 
the  constant  is  found  to  be 

Ci  *  <£i#  x(0)>  (4-9) 


Therefore,  the  "  zero  input  state  response  "  of  a  linear  time- 
invariant  system  can  be  expressed  as 


x(t) 


n 


Re  l 


i-1 


Xft 

<1±*  H(°)>e  u± 


(4-10) 


The  scalar  product  <r^,  ?c(0)>  represents  the  magnitude  of  the 
mode  of  the  system  due  to  the  initial  condition*.  If  the  initial 
conditions  are  taken  along  the  i eigenvector,  then  only  the  i^  mode 
is  excited.  The  scalar  products  <r  ,  x(0)>  where  i  +  j  are  identi- 

-j  — 

cally  zero.  Therefore  for  *  linear,  time-invariant,  unforced  system 
with  distinct  eigenvalues  the  free  motion  response  is  given  by  a  linear 
weighted  sum  of  the  modes  e^Si  ,  where  X,  is  an  eigenvalue  of  the  sys- 
tem  matrix  A. 

Consider  the  most  general  case  in  which  the  coefficient  matrix 
has  a  complex  eigenvalue  Xj,  then  X2  *  complex  conjugate  of  Xj  *  Aj* 
is  also  an  eigenvalue.  The  eigenvectors  and  u2  corresponding  to  X} 
and  X^  are  also  complex  conjugates  such  that  ja2  =*  _ax  , 
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Then,  from  equation  (4-8) 
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The  normalization  condition  for  the  complex  eigenvectors  is  given 
by 


<uj ,  u*>  +  <u”»  uj>  =*  1  (4-13) 

Using  the  above  results,  tne  free  motion  of  a  system  with  k  pairs 
of  complex  eigenvalues  is  given  by  the  expression  [55] 
k  „  r 

x(t)  -  7  eaicl[<r' ,x(0)>ccs6  t  +  rV,x(0)  sing.tju*  + 

i=l  ~i  “  i  -t  ~  i  -i 

(<r^,3t(0)>cos8it  -  <jr^  ,x(0)  >sinB^t]  u^  }  (4-14) 

The  amplitude  and  phase  cf  each  oscillatory  mode  depends  only  on 
the  iritial  conditions. 

When  the  initial  conditions  are  equal  to  ui' ,  that  is 

x(0)  *  u’  (4-15) 

the  solution  of  equation  (4-14)  gives  gives  mode  1  as  follows 

x(t)  =  e®!1"  [(cos6jt)_uj  -  (singjOu^'l  (4-16) 

When  the  initial  conditions  are  equal  to  u” ,  then  the  solution 
gives  mode  2  given  below 

[(cos^Ou"  +  (sin^tju*  ] 


x(t)  *  e0^ 


(4-1  7) 
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The  equations  derived  above  give  the  "  zero  input  state  response  " 
of  a  linear  time-iuvariant  system  whose  coefficient  matrix  has  some 
distinct  complex  conjugate  eigenvalues  and  corresponding  complex  conjugate 
eigenvectors. 

In  general,  the  matrix  A  is  real  and  non-symmetric  for  the  legged 
locomotion  systems  considered  in  Chapter  III.  It  has  both  real  and  com¬ 
plex  eigenvalues  which  are  all  distinct.  Therefore,  the  theoretical  re¬ 
sults  given  in  tnis  section  can  be  used  to  obtain  the  linearized  system 
response  to  small  motions  about  an  equilibrium  position  of  these  legged 
locomotion  systems.  The  linearized  equations  of  motion  are  derived  in 
the  next  section,  and  these  results  together  with  the  results  of  this 
section  are  combined  to  obtain  the  various  independent  vibrational  modes 
of  the  quadruped  locomotion  system. 

4.3  Small  Angle  Equations  of  Motion  for  the  Quadruped  Locomotion 
System 

4.3.1  Basic  Theory 

In  this  section,  the  equations  of  motion  derived  in  Chapter  III 
for  the  four  legged  locomotion  system  are  linearized.  Using  the  assump¬ 
tions  of  small  motion  of  the  system  about  its  equilibrium  position,  all 
the  equations  derived  in  Chapter  III  are  systematically  linearized  by  re¬ 
placing  sines  by  the  respective  angles,  3nd  the  cosines  by  unity,  and 
ignoring  terms  involving  products  of  the  state  variables.  In  addition, 
symmetry  considerations  are  also  used  to  reduce  the  system  equations 
chat  are  obtained. 

It  is  shown  that  the  final  12  x  12  matrix  of  the  linearized  system 
decomposes  into  four  smaller  matrices.  These  four  smaller  matrices 
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describe  the  various  independent  vibrational  inodes  of  the  linearized 
quadruped  locomotion  system. 

The  following  definitions  are  used  in  the  rest  of  this  disserta¬ 
tion  with  reference  to  the  vibrational  analysis  of  the  quadruped  loco¬ 
motion  system: 

1)  Modal  Matrix  -  The  matrix  that  describes  the  various  transla¬ 
tional  and  rotational  motions  corresponding  to  the  indepen¬ 
dent  vibrational  modes  of  the  linearized  locomotion  system. 

It  should  be  noted  that  this  definition  of  a  modal  matrix  is 
different  from  that  used  in  linear  system  analysis,  where  a 
modal  matrix  corresponds  to  he  matrix  whose  columns  are 
the  eigenvectors  of  the  system  matrix.  Therefore  for  the 
linearized  quadruped  locomotion  system  in  terms  of  the  above 
definition  there  are  four  modal  matrices. 

2)  X  Axis  Vibrational  Modes  -  By  definition  the  x  axis  vibra¬ 
tional  modes  correspond  to  the  translational  and  rotational 
motions  of  the  quadruped  locomotion  system  in  the  y-z  plane. 

3)  Y  Axis  Vibrational  Modes  -  By  definition  the  y  axis  vibra¬ 
tional  modes  correspond  to  the  translational  and  rotational 
motions  of  the  quadruped  postural  system  in  the  x-z  plane. 

4)  Z  Axis  Translational  Modes  -  By  definition  the  z  axis  tran¬ 
slational  modes  correspond  to  the  decoupled  translational 
raetion  along  the  z  axis  of  the  quadruped  postural  system. 

5)  Z  Axis  Rotational  Modes  -  By  definition  t  z  axis  rota¬ 
tional  modes  correspond  to  the  decoupled  rotational  motion 
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about  the  z  axis  of  the  quadruped  postural  system.  This 
corresponds  to  a  rotational  motion  described  by  the  body 
Euler  angle  in  the  x-y  plane. 

The  linearized  equations  of  motion  are  obtained  assuming  small 
motions  about  the  equilibrium  position  for  tne  various  translational  and 
rotational  components  of  the  system  state  vector.  The  approach  is  one 
of  step  by  step  linearization  of  all  the  equations  of  Chapter  111  lead¬ 
ing  finally  to  the  linearized  equations  of  motion  for  the  quadruped. 

Considering  only  small  motions  of  the  quadruped  system  about  an 
equilibrium  point,  the  following  assumptions  are  made: 

The  Euler  angles  6,  and  i|/  are  small,  and  hence  th’  sines  of 
these  angles  can  be  replaced  by  the  respective  angles,  and  t.ieir  co¬ 
sines  by  unity. 

Using  symmetry  for  the  hip  socket  positions,  the  following 
results  can  be  obtained  (see  Figure  4). 


( 4-18) 

(4-19) 


and 


(*-20) 


hip  socket 


(a)  Quadruped  Standing  with  its  feet  directly 
below  the  corresponding  hip  joints. 


(b)  Top  View  of  the  Postural  System. 


Figure  4  The  Quadruped  Postural  System. 


43 


The  foot  position  of  leg  i  in  the  earth  fixed  coordinate  system 
is  given  by 


x 


iE 


y 


iE 


z 


iE 


(4- 


The  initial  position  of  the  center  of  gravity  of  the  machine  in 
earth  coordinates  is  given  by 
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-<*o+ci> 


-U0+c> 


(4-22) 


The  position  of  ttie  center  of  gravity  of  the  quadruped  postural 


system  in  earth  coordinates  is  {x  ,  y  ,  9), 

E  E 


From  equations  (3-14)  and  (3-31)  upon  replacing  the  sines  of  the 
Euler  angles  by  the  angles  and  cosines  by  unity,  the  linearized  trans¬ 
formation  matrices  become 


(4-23) 


(4-24) 


Assuming  that  Az  is 
E 


the  change  in  position  of  the  z  coordinate  of 
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the  center  cf  gravity  of  the  body  in  the  earth  fixed  system,  equations 
(3-29)  and  (4-23;  yield  the  components  of  the  translational  velocity  of 
the  center  of  gravity. 


(4-25) 
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From  equations  (3-30)  and  (4-24) ,  the  Euler  angle  rates  can  be 
expressed  as 
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(4-26) 


Linearizing  equations  (3-23)  through  (3-25)  gives  the  components 
of  the  translational  acceleration  of  the  center  of  gravity  of  the  body. 


(4-27) 
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Finally,  the  body  rotation  rater  are  given  by 
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Equations  (4-25)  through  (4-28)  can  be  combined  to  give  the 
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12  x  12  linearized  system  matrix  shewn  below. 
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Tlie  force  components  fX*  fy.  and  the  torque  components  L,  M, 
and  i"  are  obtained  in  ter-s  of  the  12  state  variables,  'ihen  the  12  x  12 
system  matrix  state  matrix  relating  the  fiist  derivatives  of  the  state 
variables  to  the  state  variables  is  computed. 

From  equation  (3-52)  using  small  angle  approximations, 
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(4-30) 


From  equation  (3-56)  the  total  force  applied  by  leg  i  to  the 
body  at  hip  socket  i  expressed  in  leg  coordinates  becomes 
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Then  the  total  leg  force  is  given  by  (see  equation  (3-57)) 
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Let  the  component  of  the  force  along  the  z  axis  be  of  the  form 


izL  *  ^Afzi  ~ 


(4-33) 


Therefore  from  equations  (4-32) ,  (4-33)  and  (3-58) ,  the  total 
force  vector  components  become 
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Equation  (4-34)  can  be  written  in  matrix  form  in  terms  of  all  the 
components  of  the  various  forces  and  torques  as  given  by  equatioii  (4-35) 
below. 
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The  equations  giving  leg  lengths  and  angles,  namely,  equations 
(3-35)  through  (3-37)  are  now  linearized  using  the  conditions  given  by 
equations  (4-18)  through  (4-23).  Thus 
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Substituting  (z  4-Az^)  for  zE  and  rearranging  terns  in  (4-36) 
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Ass  ume 
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Using  equations  (4-37)  and  (4-38)  and  replacing  z,  by  -(i^+c^)  * 
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-(£0+c),  gives  the  expression 
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Differentiating  equation  (4-39)  with  respect  to  time  results  in 
the  expression 
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to 


From  equation  (3-35),  the  leg  lengths  are  approximately  equal 
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The  linearized  expression  for  angle  is  obtained  from  equations 
(3-36),  (4-39)  and  (4-41) 
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The  time  derivatives  of  leg  lengths  and  angles  are  obtained  from 
equations  (4-41)  through  (4-43). 
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Now  the  linearized  expressions  for  the  components  L,  M,  and  N  of 
the  total  torque  vector  are  determined  as  follows. 

Linearizing  equation  (3-50)  by  replacing  sinc^  by  cu  and  coso^  by 
unity  results  in  the  expression  for  T 
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Substituting  for  f  ,  f  ,  and  f  from  equation  (4-32)  and  for 
xi  yi  zi 

f  from  equation  (4-33)  in  equation  (3-60)  results  in  the  linearized 
zi 


expression  for  given  below 
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Substituting  for  from  equation  (4-47)  and  for  from  equa¬ 
tion  (4-48)  in  equation  (3-60)  for  tl  ->  ■  i  torque  vector  T  results  in 
the  linearized  expressions  for  the  total  torque  vector  components  L,  M, 
and  N  given  below. 
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4.3.2  Feedback  Control  Laws 

The  types  of  feedback  control  laws  that  are  used  in  the  control 
of  the  quadruped  ise  leg  angles  and  leg  angle  rates  as  a  function  of 
time.  A  simple  linear  postural  control  scheme  for  use  with  the  quadru¬ 
ped  would  use  the  following  control  laws. 

For  vertical  control,  the  vertical  force  applied  by  leg  i  to  the 
body  at  hip  socket  i  expressed  in  leg  coordinates  is  given  by 


V*i  -  V 


+  C£*i 


(4-50) 


where  C  ,  and  C*  are  predetermined  constants. 

I  i 

For  lateral  control  the  torque  Ts^  produced  by  a  centering  spring 
and  damper  system  is  of  the  form 


*1  *  VBi  -  V  +  cfl  *  Vz  +  % 


(4-51) 


where  C  ,  C.,  C  ,  and  C.  are  predetermined  constants. 

a’  8  y  y 

Longitudinal  control  requires  a  control  law  giving  the  hip  motor 
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torque  Tn^  required  to  maintain  control  of  the  machine  in  the  iongi- 
tudinal  plane.  The  law  used  for  longitudinal  control  is  given  below. 


r_  *  C  (a.  -  o  )  +  C.a,  +  C.x 
a  i  a  i  x  1 


(4-52) 


where  C  ,  C*,  and  C.  are  predetermined  constants  and  a  is  the  desired 

Cl  u  X 

hip  angle  for  leg  i,  whenever  leg  i  is  in  contact  with  ground. 

4.3,3  Postural  System  Control  L  mb 

For  postural  control  the  quadruped  is  made  to  stand  on  all  its 
feet  with  the  feet  vertically  below  the  respective  hip  joints.  This 
condition  is  equivalent  to  the  following  initial  values 
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Using  the  conditions  of  equation  (4-53),  and  substituting  fcr 

» 

o±  ,  ct^  from  equations  (4-42)  and  (4-45)  in  equation  (4-52)  and  using 
the  results  of  equations  (4-25)  and  (4-26) ,  the  linearized  expression 
for  the  longitudinal  torque  simplifies  to 
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Using  the  conditions  of  equation  (4-53),  and  substituting  for  6^, 
and  6^  from  equations  (4-43)  and  (4-46)  in  equation  (4-51) ,  and  simpli¬ 
fying  the  expression  results  in  the  linearized  control  law  for  the 
lateral  torque  T  given  below  in  equation  (4-55) . 
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From  equation  (4-50)  upon  simplification,  the  control  law  for 
the  vertical  force  A f'  reduces  to  the  expression 


4f’i  ■  C£fai®“bi*^A*Bl  +  c£ta1<,~bip"wl 


(4-56) 


Equations  (4-54)  through  (4-56)  describe  the  postural  system 

control  laws  in  terms  of  the  state  variabi-  ?  the  quadruped  system. 

4.3.4  Total  Forces  and  Moments  Applied  to  fo&  Body 

To  compute  the  total  force  components  f  ,  f  ,  f  in  terms  of 

x  y  z 

the  state  variables,  substitution  of  the  above  expressions  f  , 

Tg  ,  and  Af^into  equation  (4-34)  and  simplification  by  collecting 
terms  and  summing  over  i  *>  1,  ...4,  using  the  symmetry  properties  of 
equations  (4-18)  through  (4-20)  results  in 
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4C  /  C*  40O 

-~-lx  +  -^{G^-  -a4u+(mg-  — )  (£o*c) 6-4 (Vtc)  C. q 
*o  £?  E  ao  x  *o  T”  TT"  « 


*? 


[5£-  iL(CB+£0e  )3y  -  j>  ( C^+£0C. ) v- (rag~4_£)  (^Ovc) 0+4 (  Vfc) C  <  p 


O  If 


1  E  -J  P 
xo 


— 4[C  Aa.  C.w) 

£  E  » 


*o  *o 


L  1  *  * 

(4  :,/) 

The  components  of  the  total  torque  vector  JT,  namely,  L,  M,  '«  are 


obtained  in  terms  of  the  state  variables  by  substituting  tor  T 


v  V 


Af’  ,  a.,  8.,  etc,  in  equation  (4-49).  After  simplifying  and  coller- 
ting  terms  the  following  expression  is  obtained  for  the  total  torque 


vector  T 


L 

{ ( -mgc+4  (^o+c)  (Cg+f,0Cy)  ]y^-H-4(^o+c)2Cg-4b2Cj)-h-)gc(fco-t-c)  ]  i, 

c  #2  j 

*"o  *0  *0  ^o 

+[4(^o+c)  (CvMoC*)  ]  v-[4C»  (^c?+c)2+  4b~C«  }o) 

—  8  y  B  3, 

lo  *§ 

T  = 

M 

* 

{£fi.c“4(*'0+c)C„]x_-{4(io+c)  (C—inC.)  ]uf[mgc(2o+c)-4a2C/,- 
9  o'  E  *"  a  ax  t 

0  9  2  s  » 

xo  *0  *0 

2 

4(*,o+c)C_]6-4[a2C.  •S(^o+c)2C,  Jq} 

1  ll  n 

R 

•  - 

{ [mg(a2+b2)-4  (n2C0+b2C  ) J  tp— 4  [b2C«+a2C. ]  r} 

— ~  p  a  — r  a  8 

9  #2  a  2 

*0  *0  xo 

J 

(4-58) 


4.3.5  State  Variable  Representation  of  the  Small  Angle  Equations 

of  Motion  of  the  Quadruped  Locomotion  System 

The  theory  of  linearization  of  the  quadruped  equations  of 
motion  developed  above  is  now  used  to  obtain  a  matrix  representation 
for  this  system.  Upon  substituting  the  expressions  fcr  fxr  fy,  fz 
from  equation  (4-53),  and  the  quantities  L,  M,  N  from  equation  (4-58), 
in  die  system  state  equations  given  by  (4-29)  and  collecting  terms,  the 
system  state  equations  are  reduced  to  a  12  x  12  system  matrix  relating 
the  components  of  the  state  vector  £  to  their  respective  first  deriva¬ 
tives  with  -xespect  to  time.  This  12  x  12  system  matrix  given  below  in 
equation  (4-59)  decouples  into  four  smallei  matrices  as  indicated  by 
the  dotted  lines.  These  four  smaller  matrices  describe  the  four  inde¬ 
pendent  vibrational  systems  cf  the  quadruped  postural  system. 
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where 


A  '  -  4 


(4-60) 


B  «  -  (4C£/ra) 


(4-61) 


C  =  mg(a2+b2)  _  4(s2CB*Kj2Co) 


2o  *zz 


^zz^o 


(4-62) 


D  -  -(4/1  l2)[b2C.  +  a‘C.] 


(4-63) 


E-  i(g/t0)  -  14C _/n£0)3 


(4-64) 


F  =  [-(4C./mt2)  +  (4C./ra£0)] 


(4-65' 
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fe>»w»mn  «. 


] 

as 


0 


G  "  [ (gc/ tQ)  -  {4(£0+c)Ca/m£2}] 

H  -  I-  l4ao+c)C./ra£2}) 

I  -  l“t 4 (£0+c) Cjj/Iyy 4q]  +  Imgc/I^J) 


(4-66) 

(4-67) 

(4-68) 


J  ,:  {[4(£0+c)(ft0Cj;-C£)]/(lyy£2)}  (4-69) 

K"  tfin8cUo+c)/Iyy*ol“f4a2Ci/iyy]-{4(£0+c)2ca/(iyyt§)])  (4-70) 
L«  M4(20+c)2C./(I  £*)]  -  [4a2C:/I  j } 


a  yy  °"  l_T“  V’t/J- yyJ 
2. 


M  *  ttg/*ol  “  [ 4 (Cg+AcC  ) / (mil) ] } 


N  *  “[4(Cg+ji0C^)/(m£2)] 


P  -  (14 (£0+c) Cg/ (mi^) 3  -  (gc/t0) } 

Q  -  (4(£0+c)C./(«42)] 

R*  U*<*o+cKcft+toy/(iJ0l4)|  -  (ttgc/d^gn 


S  -  [4(A0+c)(C.+l0C.)/(I3nt£2)J 


T  »  Urcgc(£0+c)/(Ixx£0)3-[4b2CJt/(Ixx)]-t4(*o+c)2C6]} 
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U  -  - 


Xxx  i‘^£o+c)2C./(£o)3  +  b^Cj} 


(4-71) 

(4-72) 

(4-73) 

(4-74) 

(4-75) 

(4-76) 

(4-77) 

(4-78) 

(4-79) 


:  From  equations  (4-59)  through  (4-79) ,  it  is  seen  that  the 
Unearned  equations  of  motion  for  the  quadruped  locomotion  system  de¬ 
compose  into  basically  four  types  of  vibrational  systems  which  are 
independent  of  each  other.  The  upper  left  nand  2x2  matrix  in  equa¬ 


ls 
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tion  (4-59) ,  describes  the  vibrational  inodes  of  translation  along  the 
z  axis.  The  other  2x2  matrix  describes  the  vibrational  system  asso¬ 
ciated  with  rotations)  modes  about  the  z  axis.  The  next  matrix  in  equa¬ 
tion  (4-59),  which  is  a  4  x  4  mutrix  represents  the  vibrational  system 
associated  with  the  vibrational  modes  describing  translational  motion 
along  the  x  axis  along  with  rotational  motion  described  by  the  Euler 
angle  0  about  the  y  axis.  Finally,  the  lower  right  hand  4x4  matrix  in 
equation  (4-59)  represents  the  vibrational  system  associated  with  modes 
made  up  of  translational  motion  along  the  y  axis  along  with  rotational 
motion  described  by  the  Euler  angle  4  about  the  x  axis. 

4.4  Intuitive  Approach  to  the  X  Axis  Vibrational  Modes 

Assume  that  initially  the  quadruped  is  stand--  on  its  four  legs 
with  its  feet  directly  below  the  respective  hip  joint.  The  system  is 
then  slightly  disturbed  from  this  equilibrium  position  such  that  only  the 
vibrational  modes  representing  translational  motion  along  the  x  axis  with 
rotational  motion  8  about  the  y  axis  is  generated.  It  is  intuitively 
assumed  that  such  decoupling  of  the  vibrational  modes  for  the  quadruped 
postural  system  exists.  This  assumption  gives  rise  to  the  following 
conditions: 

1)  The  Euler  aigles  bee. ae 

8  *  small 

4-0  (4-80) 

4-0 

2)  The  position  of  the  center  of  gravity  of  the  body  relative 
the  earth  fixed  frame  has  coordinates 
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♦Jrf'SA*1***’-  * 


x£  *  small 

yE  “  0  (4-81) 

ZE  "  ‘ZE0 

where  zv  *  intial  value  of  the  z  coordinate  of  the  center 
ao 

of  gravity  of  the  body  in  the  earth  fixed  frame. 

3)  The  initial  position  of  the  center  of  gravicy  of  the  body  in 
earth  fixed  coordinates  is 


yEo  -  0  (4-82) 

Zp.  »  “(i0+c) 

“o 

where  *  initial  length  of  all  four  legs  of  the  quadruped* 
and  c  *  z  coordinate  of  all  four  hip  sockets  of  the  body. 

4)  The  foot  position  of  leg  i,  i»l,...4,  in  earth  fixed  coordi¬ 
nates  is 


*iE  *  ai 
yiE  *  bi 


5)  The  leg  angles  have  values 


*  small 


3±  -  0 


(4-83) 


(4-84) 


6)  Since  the  quadruped  is  assumed  to  he  excited  in  the  particu¬ 
lar  vibrational  modes  under  consideration  here,  the  total  moment  vector 
T  defined  by  equation  (3-16)  becomes 
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T  -  CO,  K,  0]T  <4-85) 

7)  The  total  force  vector  _f  (see  equation  (3-58)),  reduces  to 


m  mm 

4 

I  s 

i-1  1 

l  - 

fy 

m 

0 

(4-86) 

^z 

-ag 

since  the  total  z  axis  component  of  the  total  force  equals 
the  negative  of  the  weight  of  ‘'he  body. 

Assuming  that  sinB  can  be  replaced  by  9,  and  cosO  equals  unity, 
and  substituting  equations  (4-85)  and  (4-86)  into  the  equations  of 
motion  derived  in  Chapter  III,  namely,  equations  (3-23)  through  (3-28), 
the  body  translational  velocity  components  and  the  components  of  body 
rotational  rate  measured  about  the  x,  y,  z  axes  become 


u  -  (fx/m)  -  g8 

(4-37) 

v  ®  0 

(4-88) 

w  ■  0 

(4-89) 

p  «  0 

(4-90) 

q  *  0*/lyy) 

(4-91) 

r  -  0 

(4-92) 

Using  the  assumptions  outlined  in  equations  (4-UG)  through  (4-86) 
the  equations  derived  in  Chapter  III  are  systematically  linearized  to 
get  expressions  for  fx  end  M,  and  thus  for  u  sad  q  in  terms  of  the  state 
variables. 

Simplification  of  the  transformation  matrices  T^,  X^  and  T^yields 
[see  equations  (3-14),  (3-31),  and  (3-52)] 
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(4-93) 


(4-34) 


(4-95) 


The  position  of  the  foot  of  leg  i  in  body  coordinates  becomes 


»  — 

—  — 

X, 

X 

y± 

«  T 

1 

^XiB~XE^ 

(yiE~yE) 
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ai“(£o+c)6-xE 

bi 

zi 

_ 

^ziE*"ZE‘> 

ai8+(l0+c) 

From  equation  (4-96) 


(4-96) 
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(Xj-a^ 

-Cx  +  (t0+c)e] 
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!'rbi> 

-t 

0 

izi~c±> 

■  — 

£a±0  +  i0l 

From  equations  (4-S7)  and  (3-35),  neglecting  the  terra  [-6(£0+c)+ 
xg]2  as  compared  to  [i^a^e]2  ,  the  leg  lengths  and  their  time  deriva¬ 
tives  are  given  by 


*i  =  £*o  + 


(4-98) 
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S-i  =  (4-99) 

rrom  equations  (3-36),  (4-98),  and  (4-99)  linearization  results 
in  the  following  expression  for  leg  angle 


ai  s  -llx  +(to+c)e]/Uo-raie) ) 


(4-100) 


•SAsISWS  !  iJ«_  »'» 


W  l< 


* O  h 
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ct0+  ai9) 


(4-106) 


The  z  component  of  the  total  force  applied  by  leg  i  to  the  body 
is  assumed  to  be  given  by  the  expression 


f£  -  [C£(ii-£0)  +  Cjii  -  (mg/4)] 


(4-107) 


The  total  leg  force  vector  components  in  body  coordinates  then 
become  (see  equations (3-5 7) ,  (3-58)) 


i«l  i-  1 

0 
4 

JA 


(4-108) 


Simplification  of  equation  (4-108)  using  equations  (4-102) , 
(4-104) ,  (4-107) ,  and  the  symmetry  conditions  of  equations  (4-18) 
through  (4-20)  results  in  the  linearized  equation  for 

i  r 4c  Acs 

f x  -  — flUo+c)  9+x  ] -  -75!  Uo+c)  S+xJ*^**  +tag[x  -H£0+c)  3] 

to  B  xo  a  1  B  ° 

n  OO 


*2 


(4-109) 


From  equations  (3-50),  (3-59),  and  (3-60)  the  component  M  of  the 
total  torque  vector  finally  reduces  to  the  expressior, 

K  =>  l[xg+U0+c)6Hmgci0-4Ca(t0+e)}  -  4C^(i0+c)  [xE+(£,o+c)0]+4Cj(2.o+c)Xp 


-4a2 (C  0  +  C.0)},, 

i  £  (4-110) 


From  equations  (3-2S),  (3-30), 


(4-93),  and  (4-94) 


xE  -  u  (4-111) 

8  -  q  (4-112) 

Application  of  the  expressions  for  f  and  M  from  equations 

x 

(4-109)  and  (4-110)  :.n  the  equations  of  motion  (4-87)  and  (4-91)  results 
in  the  equations  expressing  u  and  q  in  terms  of  the  state  variables. 

The  translational  acceleration  along  the  x  axis  ia  given  by  the 
relationship 

u  -  U(g/t0)  -  (4C&/mi^)]xE  +  [(4/mi|)(C^i0-C^)]u  +  [(gc/£c)  - 

{  4Ca (  £0+c)  /ra£2  }  ]  9-  [  4C>  ( £Q+c)  /  (ra*  2)  3  9  > 

(4-113) 

The  angular  acceleration  of  the  body  about  the  y  axis  becomes 
equal  to 

q  -  Kl/Iyyi^)  [nigCi0-4a0+c)Ca]XE  +  [4(£0+C)/(lyy£2)][i0CrCi3U 

+(1/I  4)tngclo(lo+c)„482A2Ci-4coao+c)2]8  -  (4/1  £2)[a2A2C.+ 
Y7  yy  *■ 

(£0+c)2C.]q) 

(4-114) 

From  equations  (4-111)  through  (4-114),  the  linearized  system 
matrix  that  describes  the  x  axis  vibrational  modes  for  small  disturban¬ 
ces  of  the  system  from  its  equilibrium  position  can  be  written  down. 

This  matrix  is  given  below. 


In  equation  (4-115),  the  quantities  E,  F,  G,  ...  L,  are  given  by 
expressions  from  equations  (4-64)  through  (4-71)  respectively. 

Equation  (4-115)  describes  the  linearized  system  for  small  mo¬ 
tions  associated  with  the  independent  vibrational  modes  of  translation 
along  the  x  axis  together  with  rotation  6  about  the  y  axis,  that  is  the 
modes  associated  with  motions  in  the  y-z  plane.  Comparing  this  modal 
matrix  derived  intuitively  considering  that  the  x  axis  modes  are  decoup¬ 
led  from  the  other  vibrational  systems,  with  the  results  obtained  by 

rigorous  analysis  (aee  equation  (4-60)),  it  is  seen  that  the  two  results 

•  % 

are  identical.  Using  a  similar  intuitive  aj’i.oach,  it  is  possible  to 
derive  the  modal  matrices  associated  with  the  translational  and  rota* 
tional  motions  with  respect  to  the  y  axis  as  well  as  the  z  axis.  For 
dynamical  systems  whose  vibrational  modes  do  not  decouple,  the  lineari¬ 
zed  system  matrix  should  be  obtained  by  rigorous  analysis, 

*.5  Small  Angle  Equations  of  Motion  for  the  Inverted  Pendulum  System 

The  equations  of  motion  for  the  inverted  pendulua  system  derived 
in  Section  3.4  are  now  linearized  and  a  state  variable  representation 
for  the  small  angle  equations  of  motion  for  this  system  is  obtained. 
Consider  the  following  system  of  state  variables 

x  -  4>  (4-116) 

1  1 
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x  -  *  (4-117) 

2  2 

x  -  l  -  x  (4-118) 

3  1  1 

x  *  $  ■  x  (4-119) 

*4  2  2 

Substituting  these  state  variables  in  the  equations  of.  motion  of 
the  inverted  pendulum  system  given  by  equations  (3-72)  and  (3-73) 
results  in  the  following  system  of  equations 

ra£2x  +mi.rx^cos(xi-x2)+ra£,rx2sin(xl-x2)-mgfcsinxi  »  ~M  (4-120) 

(I+mr2)x  +m£rx  cos(x  -x  )-m£rx2sin(x  -x  )-mgrsinx  «  M  (4-121) 
*4  3  12  3  12  2 

Replacing  the  cosines  by  unity,  and  the  sines  by  their  angles, 
and  ignoring  terms  containing  products  of  the  state  variables,  the 
linearized  equations  for  the  inverted  pendulum  system  are  obtained. 

m£2x3  +  m£rx4  -  mgl-Xj  *  -M  (4-i22) 

(I-fmr2)x4  +  mirx3  -  tngrx2  *  M  (4-123) 

In  equations  (4-122),  and  (4-123),  m  *  mass  of  the  body,  r  “  dis¬ 
tance  of  the  pivot  below  the  center  of  gravity  of  the  hody,  £  »  constant 
length  of  the  supporting  leg,  g  *  acceleration  due  to  gravity,  and  M  * 
control  torque  applied  to  stabilize  the  system. 

Assume  a  control  torque  of  the  form 

M  *  KjX2  +  KjX^  +  K3Xj  +  K4x3  (4-124) 

Substituting  equation  (4-124)  in  equations  (4-122)  assd  (4-123) , 
and  simplifying  the  resulting  expressions,  the  equations  of  the 
linearized  system  are  obtained  in  terms  of  the  state  variables  and  the 


control  constants  K  through  K.  . . 

1  4 


mft  x  +  mine  +  (K  -ogfc)x,  +  K  x  +  K  x  •!•  K  x  -0  (4-125) 

3  4  31  124324 


m£rx  4-  (I+rar  )x;  -  K  x  -  (K  +mgr)x<>  -  K  x  -  K  x  ■  0 
3  4  31  12  43  24 


(4-126) 


The  above  equations  can  be  further  simplified  by  using  the  fol- 
lov/ing  substitutions. 


*  m£ 

A  ■  (I  +  mr2) 

2 

A3  ■  m£r 

»  (K3  -  mg£) 

A5  *  ^K1  +  mgr^ 


(4-127) 

(4-123) 

(4-129) 

(4-130) 

(4-131) 


Then,  equations  (4-125)  and  <4-126)  can  be  expressed  in  the  form 


V3  +  A3*4  +  Vl  +  K1x2  +Vb  ■  ¥*.  ‘  0 


(4-132) 


A3x3  +  A2x4  -  KjXj  -  AgX2  -  Kf^Xj  -  K?x4  *  0  (4-133) 


Solving  these  equations  simultaneously  for  and  x^,  the  linear¬ 
ized  system  state  equations  become 


X1  *  X3 


x2  «  x„ 

[(A2A4+A3K3)x1f(A2K1+A3A5)x2+(A2+A3)K^x3+(A2+A3)K2x43 

U,A2  -  A|1 


(4-134) 

(4-135) 


(4-136) 


<  sew-stot- 
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* 

X,, 


[(A1K3+A3Alt)x1+(A1As+A.K1)x.,+(A1+A3)K4X3+(A1+A3)K2x4] 


[AjA2  -  Ap 


(4-137) 


Equations  (4-134)  through  (4-137)  are  the  linearized  system  state 
equations  for  the  inverted  pendulum  system  with  z  "  fixed  "  foot,  and  a 
massless  leg  with  the  mass  pivoted  below  its  center  wf  gravity. 

Equations  (4-134)  through  (4-137)  can  be  put  in  the  following 
matrix  form 


0 

0 

B 

v 


1 

0 

c 

6 


(4-138) 


where 


A  *  -  [(A2At,+A3K3)/(A1A2-A3)] 

(4-139) 

3  -  —  [(A3A5EA2K1)/(A1A2-A3)] 

(4-140) 

c  «  -  ((A2+A3)K||/(A1A2-A3)] 

(4-141) 

D  =  -  t(A2+A3)K2/(A1A2-A*)] 

(4-142) 

E  -  t(A3A4+A1K3)/(A1A2-A3)] 

(4-143) 

F  -  l(A1A5+A3K1)/(A,A2-A3)i 

(4-144) 

g  «  [(a1+a3)k4/(a1a2-a3)3 

(4-145) 

H  -  [(A1-5*A3)K2/(A1A2-A3)] 

(4-146) 
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The  state  variable  represen' a ti on  of  the  linearized  equations  of 
motion  given  above  will  be  used  to  obtain  the  linear  system  response  of 
Che  inverted  pendulum  system  for  small  motions  about  its  equilibrium 
position.  This  matrix  representation  is  also  used  for  the  application 
of  the  Routh-Hurwitz  test  to  determine  stabilizing  control  constants 
for  this  system. 

4.6  Summary 

In  this  chapter,  the  application  of  vibrational  analysis  to 
legged  locomotion  systems  has  been  described,  and  the  basic  equations 
for  the  linearized  systems  of  these  dynamical  systems  have  been  deri¬ 
ved. 

It  is  shown  that  the  system  equations  of  the  quadruped  after 
linearixation  yield  a  12  x  12  s rstem  matrix  which  decomposes  into  four 
smaller  matrices.  These  smaller  matrices  describe  the  various  inde¬ 
pendent  vibrational  systems  of  the  quadruped  postural  system  correspon¬ 
ding  to  the  translational  and  rotational  motions  associated  with  the  x, 
y,  and  z  axis  respectively. 

Next,  using  intuitive  assumptions  of  a  decoupled  system,  the 
linearized  equations  for  the  vibrational  modes  associated  with  motions 
in  the  y-z  plane  (x  axis  modes)  are  derived  separately.  A  comparison 
between  the  approaches,  namely,  the  rigorous  analysis,  and  the  intui¬ 
tive  approach,  shows  that  their  results  are  identical. 

The  chapter  concludes  with  the  derivation  of  the  linearized 
equations  of  motion  for  the  inverted  pendulum  system  discussed  in  Sec¬ 
tion  3.4.  These  linearized  equations  will  be  used  in  later  chapters 
for  computing  the  eigenvalues  and  eigenvectors  of  .he  linear  system 
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and  hence  obtaining  the  linear  system  response  for  small  perturbations. 
Then,  the  nonlinear  system  is  excited  along  the  sane  Independent  vibra¬ 
tional  modes,  and  its  response  compared  with  the  linearized  system 
response.  It  is  shown  in  Chapter  VII  that  these  two  responses  agree  for 
small  motions  to  tbe  desired  degree  of  accuracy,  thereby  verifying  the 
nonlinear  quadruped  simulation,  as  wall  as  the  linearization  techniques. 


CHAPTER  V 


EIGENVALUES  AND  EIGENVECTORS 

5.1  Introduction 

This  chapter  discusses  the  problem  of  finding  the  eigenvalues  and 
eigenvectors  of  the  real,  non-symmetric  modal  matrices  obtained  for  the 
linearized  locomotion  systems  in  Chapter  IV.  Eigenvalues  and  their  cor¬ 
responding  eigenvectors  are  needed  to  compute  the  linear  system  response. 

At  the  present  time,  practical  computer  programs  for  determining 
the  eigenvalues  and  eigenvectors  of  general,  non-syianetric,  real,  square 
matrices  are  not  many  in  number,  and  numerical  analysis  techniques  in 
this  area  are  still  being  improved.  The  purpose  of  this  chapter  is 
mainly  to  outline  the  applicaiton  of  some  recently  published  "  state-of- 
the-art  "  computational  subroutines  in  this  area  on  the  linearized  loco¬ 
motion  system  matrices.  Accordingly,  Section  5.2  discusses  briefly  some 
of  the  methods  for  solving  the  complete  eigenvalue  problem  for  non- 
symmetric,  real  matrices.  Section  5,3  outlines  the  use  of  subroutines 
NSEVB  and  EIGENP  for  finding  the  eigenvalues  and  eigenvectors  of  the 
linearized  system  matrices  of  both  the  quadruped  as  well  as  the  inverted 
pendulum  systems, 

5.2  The  Complete  Eigenproblem  for  Non-Symmetric,  Real  Matrices 

There  are  different  methods  available  in  the  literature  for 
finding  the  eigenvalues  and  eigenvectors  of  non-symmetric,  real 
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matrices  [56-59].  Some  of  these  methods  are  discussed  briefly  in  this 
section.  In  these  methods,  a  series  of  simularity  transformations  are 
performed  in  order  to  reduce,  the  non-symmetric  matrix  A  to  either  a  tri¬ 
diagonal  matrix,  or  a  Hessenberg  matrix  with  eigenvalues  which  are  the 
same  as  those  of  A  but  more  easily  computable. 

5.2.1  Method  of  Lanczos  [60] 

In  this  method,  a  similarity  transformation  is  used  to  reduce  the 
non-symmetric,  real  matrix  into  a  tridiagonal  matrix.  The  eigenvalues 
and  eigenvectors  of  this  transformed  matrix  are  then  computed. 

5.2.2  The  LR  Transformation  [61] 

This  method  can  be  applied  to  an  arbitrary  matrix,  however  it  is 

particularly  useful  for  matrices  in  the  tridiagonal  or  the  Hessenberg 

form.  Tills  method  is  based  on  the  successive  decomposition  of  a  sequence 

of  matrices  {A  }  all  of  which  have  the  same  form  as  the  original  matrix, 
k 

The  process  of  deriving  the  sequence  tAj}  from  A  by  successive  tri¬ 
angular  decompositions  is  called  the  Left-Right  (LR)  transformation. 

This  method  converges  for  a  large  cla^s  of  matrices  including  all 
symmetric,  positive  definite  matrices,  many  matrices  with  distinct,  real 
eigenvalues,  and  many  matrices  with  real  eigenvalues  which  satisfy 
neither  of  these  two  conditions.  This  method  may  not  converge  for  some 
matrices  with  complex  eigenvalues.  Also,  triangular  decomposition  may 
not  always  be  numerically  stable  even  for  matrices  having  only  real 
eigenvalues , 

5.2.3  The  OR  Transformation  [62] 

This  method  is  analogous  to  the  LR  transformation  but  is  more 
numerically  stable  since  it  makes  use  of  orthogonal  transformations 


rather  than  triangular  decompsition.  This  method  becomes  too  laborious 
for  arbitrary  matrices,  and  is  used  mostly  on  special  matrices  such  as 
the  Hessenberg  matrix  or  symmetric-band  matrices. 

A  good  general  purpose  scheme  for  solving  che  complete  eigenvalue 
problem  for  non-symraet?ic5  real  matrices  is  to  first  reduce  the  matrix 
to  the  Hessenberg  form  using  the  Gaussian  elemiration  technique,  and  then 
to  use  the  QR  transformation  on  the  reduced  matrix  to  calculate  the 
eigenvalues.  The  eigenvectors  can  then  be  computed  by  methods  such  as 
the  inverse-iteration  procedure. 


5.3  Determination  of  the  Eigenvalues  and  Eigenvectors  of  the 
Linearized  Locomotion  System  Matrices 

The  linearized  locomotion  system  matrices  for  the  quadruped 

vibrational  modes  and  the  inverted  pendulum  system  were  derived  in 

Chapter  IV.  From  the  results  of  Chapter  IV,  the  types  of  matrices  under 

consideration  are  of  the  following  forms: 


* 

10  0 
0  0  1 
ABC 
E  F  G 


where  A,  B,...,  H  are  all  scalars.  Therefore,  these  non-symmetric,  real 
matrices  may  have  ra  ii  as  well  as  complex  conjugate  eigenvalues  and  co¬ 
rrespondingly,  real  and  complex  conjugate  eigenvectors. 

After  a  snrvey  of  practical  methods  for  determining  the  eigen¬ 
values  and  eigenvectors  for  non-symmetric,  real  matrices,  two  "  state-¬ 
of-the-art  ”  methods  that  are  particularly  applicable  to  the  problem 
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at  hand  were  found  [63,65].  At  the  present  time,  the  problem  of  finding 
the  eigenvalues  and  eigenvectors  of  general  non-symmetric,  real  matrices 
is  receiving  a  lot  of  attention,  and  in  the  near  future  more  practical 
computer  algorithms  should  become  available. 

In  the  method  of  Grad  and  Brebner  [63'],  namely  subroutine  EIGENP, 
the  following  steps  are  carried  out.  The  matrix  is  scaled  by  a  sequence 
of  similarity  transformations  so  that  the  .bsolute  sums  of  the  corres- 
onding  row3  and  columns  are  roughly  equal.  Then,  the  scaled  matrix  is 
normalized  so  that  the  square  of  the  Euclidean  norm  is  equal  to  unity. 
This  matrix  is  then  reduced  to  an  upper-Hessenberg  form  by  means  of 
similarity  transformations  (Householder's  method).  Then  the  eigenvalues 
are  computed  by  the  QR  double-step  method  and  the  corresponding  eigen¬ 
vectors  by  inverse  iteration. 

Subroutine  NSEVB  [64,65],  is  another  program  that  can  be  used  for 
the  numerical  solution  of  the  non-symmetrlc  eigenproblem.  In  this 
subroutine,  the  real  general  matrix  is  first  reduced  to  an  almost  upper- 
triangular  form  by  stabilized,  elementary,  similarity  transformations. 
Then,  the  QR  dcuh le-step  algorithm  is  applied  to  the  reduced  matrix. 

The  eigenvectors  are  then  computed  by  Wielandt's  inverse  iteration 
method.  For  the  case  of  well  separated  eigenvalues,  rigorous  machine 
hounds  are  given  for  the  computed  eigensystem  using  Gerschgorin's 
theorem. 

The  Fortran  subroutine  EIGENP  and  a  Fortran  version  of  the 
original  Algol  subroutine  NSEVB  were  used  on  an  IBM  360/75  computer  to 
determine  the  eigenvalues  and  eigenvectors  of  the  non-symmetric,  real 
matrices  of  the  linearized  locomotion  systems  of  the  type  discussed 


above.  These  matrices  yielded  both  real  and  complex  conjugate  eigen¬ 
values  and  eigenvectors  which  were  then  used  to  compute  the  linear 
system  response  as  discussed  in  Section  4.2, 

5.4  Summary 

This  chapter  has  briefly  outlined  the  methods  available  for 
solving  the.  eigenproblem  for  general,  non-aymroetric,  real  matrices.  The 
computational  algorithms  used  in  this  research  for  the  determination  of 
the  eigenvalues  and  eigenvectors  of  the  linearized  locomotion  system 
matrices,  namely  subroutines  EIGENP  and  NSEVB  have  also  been  described. 

In  this  chapter,  no  attempt  has  been  made  to  present  the  computa¬ 
tional  details  of  any  of  these  methods.  The  numerical  results  obtained 
on  an  IBM  360/75  computer  are  given  in  Chapter  VII. 

In  conclusion,  this  chapter  represents  a  brief  introduction  to  the 
complete  eigenvalue  problem  for  real,  non-symmetric  matrices  encountered 
in  the  course  of  this  research. 
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STABILITY  AND  CONTROL  OF  LEGGED  LOCOMOTION  SYSTEMS 

6.1  introduction 

The  problem  of  stability  and  control  of  legged  locomotion 
systems  has  been  studied  from  several  viewpoints  in  the  past  few 
years  [16,  47,  51].  There  are  two  aspects  of  the  stability  problem 
for  legged  locraotion  systems,  namely,  static  stability  and  dynamic 
stability  [66].  For  some  of  the  slower  gaits  such  as  the  quadruped 
crawl  during  which  the  machine  is  statically  stable  at  all  times,  a 
simple  type  of  finite  state  control  has  been  successfully  used  to 
produce  stable  locomotion  [15].  For  higher  speed  gaits  such  as  the 
quadruped  trot  and  the  pace  which  are  statically  unstable  in  all 
their  phases,  other  means  of  control  need  to  be  used  to  produce 
dynamic  stability. 

This  chapter  discusses  one  such  type  of  control,  namely,  model 
reference  control.  Then  the  necessary  and  sufficient  conditions  for 
the  small  motion  stability  of  the  quadruped  and  inverted  pendulum 
systems  are  derived.  Finally,  the  application  of  the  problem  of  stabi¬ 
lity  of  the  inverted  pendulum  system  to  produce  stable  gaits  such  as 
the  quadruped  pace  and  a  form  of  the  biped  walk  is  discussed.  It  is 
suggested  that  stability  for  the  biped  is  obtained  by  two  types  of 
mechanisms,  the  body  torquing  mechanism  for  controlling  attitude  and 
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lateral  position,  and  the  ab'ility  to  choose  the  position  in  which  the 
feet  are  placed  to  maintain  stability  in  the  direction  of  motion  [66J. 

The  last  section  of  this  chapter  discusses  the  body  torquing  method  of 
control  for  producing  a  type  of  stable  biped  walk  with  the  biped  "  mar¬ 
ching  "  at  a  constant  velocity  in  the  direction  of  motion  with  a  pre¬ 
determined  fixed  stride  length.  Stability  of  the  biped  by  moving  the 
position  of  the  feet  to  produce  alternating  fall  and  recovery  phases  is 
not  covered  in  this  dissertation. 

6.2  Model  Reference  Control 

As  explained  in  the  introduction  to  this  chapter,  the  dynamic 
stability  problem  for  legged  locomotion  systems  becomes  difficult  for 
the  faster  gaits  such  as  the  quadruped  walk,  trot,  and  the  pace  in 
comparison  with  the  finite  state  algorithmic  type  of  control  which  can 
be  used  for  the  quadruped  crawl.  The  faster  quadruped  walk  contains 
some  statically  unstable  phases,  while  the  trot  and  pace  are  statically 
unstable  at  all  times.  Therefore,  for  stabilization  of  the  more  compli¬ 
cated  quadruped  gaits,  anouier  type  of  control  called  "  model  reference 
control  "  is  used  for  the  locomotion  systems  discussed  in  this  disserta¬ 
tion. 

Figure  5  shows  the  block  diagram  of  a  model  reference  adaptive 
control  system  [67].  In  this  ”  closed  loop  "  control  scheme,  the  adap¬ 
tive  controller  is  adjusted  to  minimize  the  performance  criterion.  The 

output  of  the  plan’;  c(t)  is  compared  with  the  desired  output  c  (t)  of 

d 

the  reference  model  and  the  error  e(t)  »  c(t)  -  c  (t)  is  minimized  by 

d 

the  adaptive  mechanism  so  that  c(t)  approximates  c  (t)  despite  time 

d 

variations  in  the  plant  parameters.  The  reference  model  is  assumed  to  be 
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Figure  5  Model  Referenced  Adaptive  Control  System, 
free  from  any  disturbing  influences.  The  type  of  model  reference  con¬ 
trol  scheme  used  in  the  simulation  for  obtaining  both  postural  control 
and  stable  locomotion  gaits  for  the  quadruped  system  uses  a  simplified 
version  of  the  adaptive  control  scheme  shown  in  Figure  5.  The  contro¬ 
ller  used  in  the  simulation  computes  the  control  inputs  u(t)  as  linear 
functions  of  the  error  signal.  While  more  complicated  nonlinear  control 
schemes  ought  to  yield  systems  with  better  performance  they  are  not  con¬ 
sidered  in  this  dissertation. 

For  each  type  of  gait  an  ideal  kinematic  model  is  assumed.  For 
example,  for  postural  control,  the  reference  model  of  the  quadruped  is 
assumed  to  be  standing  on  all  its  four  legs  with  the  feet  vertically 
below  the  respective  hip  sockets.  The  leg  lengths  cf  the  model  are  all 
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equal  to  £n,  the  initial  length  and  the  angles  a  and  ?  are  all  equal 

i  i 

to  zero.  The  output  of  this  ideal  kinemat  ;  model  for  the  steading 
quadruped  is  then  compared  at  each  instant  of  time  with  the  actual  plant 
and  the  controller  outputs  are  regulated  to  minimize  the  error  between 
the  ,.~ant  and  the  ideal  model  of  the  system.  Similarly,  for  the  case 
when  the  quadruped  is  moving  using  a  particular  gait,  the  ideal  kinema¬ 
tic  model  for  that  gait  is  used  as  a  reference  model. 

In  this  dissertation  the  only  type  of  control  that  has  been  con¬ 
sidered  for  producing  stable  locomotion  can  be  described  as  "  marching  " 
type  of  control.  That  is,  the  ideal  kinematic  model  moves  with  constant 
velocity  in  the  direction  of  motion,  placing  its  feet  in  the  desired 
sequence  along  predetermined  points  on  level  ground  [47J.  The  actual 
parameters  of  the  ideal  kinematic  models  describing  the  different  gaits 
and  the  control  constants  used  for  each  type  of  gait  are  given  in 
Chapter  VII. 

6.3  Necessary  and  Sufficient  Conditions  for  the  Small  Motion  Stability 
of  the  Quadruped  Locomotion  System 

one  of  the  methods  that  can  be  used  to  determine  the  range  of 
control  constants  to  a!»sure  small  motion  stability  of  the  linearized 
legged  locomotion  system  is  the  Routh-Hurwitz  criterion  [68],  This 
test  shows  the  number  of  right-half  plane  zeros  of  the  characteristic 
equation  oc  a  linear  system.  If  the  characteristic  equation  of  a  linear 
system  contains  control  constants  whose  values  can  be  changed,  the 
Routh-Hurwitz  test  gives  a  set  of  inequality  constraints  on  these  cont¬ 
rol  constants  which  must  be  satisfied  to  obtain  a  stable  system.  The 
detailed  derivation  of  the  Routh-Hurwitz  stability  criterion  and  its 
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applications  can  he  found  in  the  literature  [68,69] ,  and  will  not  he 
given  heia.  The  method  will  be  used  below  to  compute  the  control  con¬ 
stants  which  produce  small  motion  stability  for  the  quadruped  system  as 
well  ns  for  the  inverted  pendulum  system. 

The.  characteristic  equation  for  the  linearized  quadruped  system 
can  be  obtained  from  the  12  x  12  quadruped  system  matrix  given  by  equa¬ 
tion  (4-59).  But  from  the  results  of  equation  (4-59),  the  12  x  12 
system  matrix  is  seen  tc  be  decomposed  into  four  smaller  independent 
modal  matrices.  Therefore  the  Routh  test  can  be  applied  to  each  of 
these  modal  matrices  separately,  and  should  yield  constraints  on  the 
control  constants  for  stability  of  the  system  when  the  system  is  excited 
to  produce  these  vibrational  modes.  Of  the  four  modal  matrices,  two  are 
of  dimension  2x2,  and  the  other  two  are  4x4  matrices. 

Consider  the  modal  matrix  for  translation  along  the  z  axis  (see 
equation  (4-59)). 


(6-1) 


where 
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The  characteristic  equation  for  this  mode  becomes 
det  [M  -  XI]  «  X2  -  BX  -  A  «  0 
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or 
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The  Routh  array  can  be  written  as 


1  -A 


From  the  above,  the  Routh-Hurwitz  criterion  gives  the  following 


inequality  constraints  on  the  control  constants  for  stability, 

4C 


-  A  >  0  or  — =•  >0  •+■  C9  >  0 
m  * 


-  B  >  0  or  — -  >0  -*■  C!  >  0 
m  *• 


(6-6) 
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Tlie  modal  matrix  for  rotation  about  the  z  axis  is  given  by 
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The  characteristic  equation  is  given  by 
X2  -  DA  -  C  -  0 

The  Rcuth  test  gives  the  inequality  conditions 

C  <  0 


D  <  0 


(6-11) 


(6-12) 

(6-13) 


Sine-:  a*  b.  fc  ,  I  are  all  positive  for  the  quadr»'T>ed  system 
o  zz 
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which  control  constants  C.  and  C*  must  satisfy. 

a  8 

The  4x4  modal  matrices  describing  the  translational  and  rota¬ 
tional  modes  associated  with  the  x  and  y  axes  respectively,  contain  ele¬ 
ments  consisting  of  rather  long  expressions  as  can  be  seen  from  equa" 
tions  (4-59),  and  (4-64)  through  (4-79).  Therefore  the  Routh  conditions 
for  these  matrices  will  be  derived  in  terms  of  the  symbolic  representa¬ 
tions  of  these  elements. 

The  modal  matrix  for  the  x  axis  modes  is 

0  10  0 
E  F  G  H 

0  0  C  1 

1  J  K  L 

where  E,  F,  G,  H,  I,  J,  K,  L  are  given  equations*  (4-64)  through  (4-71) 
respectively.  Th°  characteristic  equation  for  this  matrix  M3  becomes 


A4-(F+'L)X3  +  v.  *HJ-E-K)A2  +  (FK-GJ+LE-HlU  +  (KE-GI)  »  0 


(6-17) 
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The  conditions  Rb  >  0  and  Rj  >  0  yield  die  inequality 

(1 F-HJ)  >  CGd-HtIH-EF+KL) 

(L+F) 


U4 


(6-27) 


From  equations  (6-26)  and  (6-27)  the  following  condition  is 
obtained 

(FK+LE-GJ-HI)  [  (LF-iiJ)  (L+F)-(GJ+HI+Er+KL)  ]-(F+L)?  (KE-GI)  <  0  (6-28) 

Substitution  of  equations  (4-65)  and  (4-?X)  for  the  quantities  F 
and  L  into  the  condition  Rj  >  0  gives  after  simplification  the  express¬ 
ion 
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x  yy 
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which  C  ,  C*.  and  C»  should  satisfy, 
x  a  S. 

Simplification  of  the  condition  R^  >  0  by  substituting  express¬ 
ions  for  li,  Fr  H,  J  and  K  yields  the  inequality 


4a2c.(c.-£oC.)+CoUyy+m<£o+c)2J  +  mS**  ^  >  Uyy^c(£+c)]rag£o 

4 

(6-30) 


The  condition  R  >  0,  reduces  to  the  inequality 


(6-31) 


Finally  from  equation  (6-24)  the  inequality  condition  R  >  0 

yields 

mSa2£ftC£  +  Cfi[mg(£0+c)-4a2C£3  <  ra2g2£0c  (6-32) 

4 


In  the  above  results,  if  some  of  tlie  control  constants  are  either 
zero  or  proportional  to  each  other  for  particular  gaits,  these  equations 


can  be  simplified  further  and  should  give  a  more  meaningful  set  of  in¬ 
equality  constraints  on  the  control  constants  from  which  the  allowable 
range  for  these  constants  can  be  determined. 
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The  condition  3g  >  0  and  equation  (6-43)  yield  an  expression 
similar  to  equation  (6-28)  for  this  particular  vibrational  system  re¬ 
presented  by  matrix  M^. 

{  (BT-rMU-PS-QR)  [  (i-iU-OS)  ( t'H-U )  - ( P S  +q R+MN+T 1) )  ]  -  (N+U)2(MT-PR)  }  <  0 

<6-44) 

A  set  of  results  similar  to  equations  (6-29)  through  (6-32)  can 
be  derived  for  the  modal  matrix  describing  the  y  axis  vibrational 
modes.  From  the  condition  S^>  0  one  gets  upon  simplification  the 
inequality 

[C.Ixx  +  mb2i0Cjl  <  1 1 m(ao+c) 

The  condition  S2  >  0  yields  the  inequality 

4b2  C; (C;+!  C.)+C  [i(l  +c)2+I  ]-Hnb2£2C+I  £  C  > 

£  6  o  Y  o  xx  o  i  xx  o  y 

Similarly  the  condition  S3  >  0  reduces  after  simplification  to 
the  condition 


2,  C8 
J  r 

o 


(6-45) 


[I  +mc  (  2.  +c) 
xx  o  4 


(6-46) 


b2[C  C.+C.C  ]4b2£_[C  C.+C.C  ]  -  [(i0+c)C.+b2£0C.)  SSS.  >  0  (6-47) 

8.  8  2  6  °  ft  a  9.  a 


£  y  £  y 


V  4 


Finally,  >  0  results  in  the  condition 


msb2£°C)l+C8{mg(£o+c)“4b2ioCiJ  “  4b2£oC£Cy  < 


2  2 

«  g  Vs 


(6-48) 


The  above  inequalities  are  the  necessary  and  sufficient  condi¬ 
tions  for  the  small  motion  stability  of  the  quadruped  locomotion  system. 


In  the  next  section,  algorithms  are  derived  to  choose  a  set  of  control 
constants  which  produce  a  stable  system  and  the  controllability  of  the 
system  is  thus  proved. 

6.4  Controllability  o:  the  Quadruped  Locomotion  System 

In  this  section  algorithms  are  developed  for  obtaining  at  least 
one  solution  to  the  Routh-Kurwitz  inequalities  derived  in  Section  6.3. 
The  existence  cf  at  least  one  set  of  stabilizing  constants  proves  the 
controllability  of  the  linearized  quadruped  system. 

To  simplify  the  analysis,  it  is  assumed  in  the  following  that  all 
the  control  constants  are  equal  to  C.  This  gives  the  condition 

Cn  *  C0  *  C.  *  C;  *  C  «  C-  =  C.  *  C  »  C.  -  C  (6-49) 

agct&iixyy 

From  this  assumption,  the  Routh-Hurwitz  inequalities  for  the  z 
axis  translational  mode  (see  equations  (6-6)  and  (6-7))  are  satisfied  if 
C  >  0. 

Applying  equation  (6-49)  to  equations  (6-14)  and  (6-15) ,  the  in¬ 
equalities  associated  with  the  z  axis  rotational  modes,  results  in  the 
conditions 

C  >  (6-50) 

4 

b2  >  -a2  (6-51) 


(6-53) 
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(6-54) 
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rag(a2t0+ao+c)  m2g2£,_c 

-  C  - - — 


(6-55) 
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An  algorigthm  can  be  developed  by  choosing  C  to  satisfy  equation 
(6-50)  as  well  as  conditions  given  by  equations  (6-52)  through  (6-55) 
for  particular  values  of  a,  b,  c,  m,  and  fcQ. 

For  the  case  when  C  *  0,  a  similar  set  of  inequality  conditions 
can  be  derived  for  the  modal  matrix  associated  with  translations  and  ro¬ 
tational  motion  about  the  y  axis.  From  the  above  analysis  a  particular 
set  of  control  constants  ccn  be  found  such  that  all  the  inequality  con¬ 
ditions  of  the  Routh-Hurwi tz  test  are  satis'  ad.  This  proves  the  con¬ 
trollability  of  the  quadruped  locomotion  system  for  small  motions  about 
its  equilibrium  position. 

A  computer  program  was  written  to  obtain  sets  of  control  con¬ 
stants  Co,  Cj,  Cg,  C£,  C^,  C£,  C^,  Cy,  and  that  satisfy  the  Routh- 
Hurwitz  test  for  all  the  modes  of  vibration  of  the  Quadruped  system. 

6.5  Stability  Criteria  for  the  Inverted  Pendulun  System 

The  Routh-Hurwitz  stability  test  is  now  applied  to  the  linear¬ 
ized  equatJ  jns  of  motion  cf  the  inverted  pendulum  system  derived  in 
Chapter  IV.  From  equation  (4-138) #  the  characteristic  equation  of  this 
system  is  given  by 

X4-(C+H)A3+(CH-DG-F-A)A2-KCF-BG+AH-DE)A+(AF-BE)  «  0  (6-56) 


where  the  quantities  A,  B,  C,  D,  E,  F,  G  and  H  are  defined  by  equations 
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(A- 139)  through  (4-146)  respectively.  Substituting  for  the  quantities  A 
through  H  the  expressions  given  in  equations  (4-139)  through  (4-146)  and 
simplifying  the  resulting  expression  yields  the  characteristic  equation 
for  the  inverted  pendulum  system  in  terras  of  the  control  constants  and 


the  parameters  m,  g,  £,  r,  and  I  as  follows 

+  Rj X3  +  R2X2  +  R  X  +  R  «  0  (6-5?) 

where 

R0  **  I£2  (6-58) 

Rj  =  [(l/m)+r2+ir]K4  -  K2£(£+r)  (6-59) 

R2  -  [  (I/m)-!-r2+£r}K3  -  Kj£(£+t)  -  (g£I+rag£r2+rag£2r)  (6-60) 

R3  *  g(K2£  -  K4r)  (6-61) 

R4  -  g(mg£r  +  Kt£-  K3r)  (6-62) 


Since  R„  *  I£z  is  positive,  for  the  stability  of  the  system 


\  >  0, 


i  ■  1.....4 


(6-b3) 


Also  from  the  first  column  of  the  Routh  array 

CRiR2- 

R  *  - —  >  0 


(6-64) 


Rc 


'R5R3  “ 
Rc 


>  0 


(6-65) 


From  equation  (6-63)  observing  that  R  should  be  greater  than 
zero,  equation  (6-64)  reduces  to  the  condition 


R  R  -  R  R  >0  or  R„  > 


R0R3 


1  2 


0  3 


(6-66) 
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Similarly  from  equations  (6-63)  and  (6-64)  and  the  condition 

Rc  >  0  tiva  following  inequality  is  obtained. 

© 

(RiRj  -  ^0R3)R3  ~  RxR4  >  0  (6-67) 


If  the  inequality  constraints  given  by  equations  (6-63),  (6-66) 
and  (6-67)  can  be  satisfied  by  a  set  of  control  constants,  then  such  a 
set  of  constants  will  produce  a  stable  system.  In  the  next  section  an 
algorithm  is  given  for  obtaining  these  stabilizing  control  constants  for 
the  inverted  pendulum  system. 


6.6  Algorithm  for  Obtaining  Stabilizing  Control  Constants  for  the 
Inverted  Pendulum  System 

The  Routh-Hurwitz  criterion  for  the  inverted  pendulum  system  con¬ 
sidered  in  this  dissertation  can  be  written  down  in  the  form  of  the  in¬ 
equality  conditions  of  equations  (6-63)  through  (6-65)  given  in  Section 
6.5. 

An  algorithm  is  now  developed  for  obtaining  at  least  one  set  of 
control  constants  that  satisfy  all  the  above  conditions*  thereby  proving 
the  controllability  of  the  inverted  pendulum  system. 

From  equation  (6-63)  using  the  conditions  Rj  >  0  and  R3  >  0 
results  in  the  following 


R1»t(I/m)+r:i+£r3KJt  -  U2-t*r)K2  >  0  •*> 
R3  «  -  K4r)  >  0  -*• 


£(£+r) 

54  T(I /in) -rt2+£rf  *2 


<  -  K 
4  r  2 


(6-68) 

(6-69) 


Therefore  the  constraints  on  K4  and  K2  are 


f  K2  <  K4 


or 


where 


a 

b 


< 


K„ 


<  A 


r 


yi 

(6-70) 


a  »  £(?.+r) 

(6-71) 

b  *  [  (I/m)+r2+Jtr] 

(6-72) 

6.6.1  A  Particular  Solution 

lo  derive  a  particular  set  of  control  constants  that  wi?l  produce 
i  cable  system,  choose 

(1)  K4  =  (6-73) 

where 

y  »  i  t(a/b)  +  ( l/r )]  (6-74) 

2 

(2)  Kj  -  f  K3  (6-75) 

The  constraint  R_>  0  yields 

R0R, 

Rs  -  R, - -  -  -  h)  >  0  (6-76) 

R, 


where 


r0r3 


(6-77) 


The  constraint  R  >  0  can  be  written  as 
6 


R3 


RjR^ 


[*2  -(W“l)l 


(6-78) 


A  particular  value  of  n  can  be  obtained  by  using  equation  (6-73) 
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in,  the  equation  defining  n»  namely  equation  (6-77). 

lue  of  n,  namely  n  is  then  given  by  the  expression 
P 

I&2g(t  ~  ru) 

P  (ap  -  b) 

Therefore  from  equation  (6-76) 

R2  >  n  (6-80) 

From  equation  (6-78) 

Rl*«» 

r3  >  (r2  -  np) 

Substituting  the  condition  Kj  “  —  K  in 

)C  J 

R4  >  0  results  in  the  condition 

R4  »  mg2r l  +  gSLYLi  -  grR3  »  mg2rfi.  >  0  (6-82) 

for  any  value  of  K3  .  Since  Rfl ,  Rj ,  R3,  and  are  all  greater  than 
zero  for  the  particular  values  of  the  control  constants  chosen  above, 
from  equation  (6-31)  the  only  other  condition  that  needs  to  be  satisfied 
is 

Rj,  >  np  (6-83) 

Upon  substitution  for  R,  and  n  from  equations  (6-60)  and  (6-79) 

P 

into  equation  (6-83)  and  simplifying  results  in  the  condition 

K3  >  [(m2g&b/I)  +  (ragi2r/b) ]  (6-84) 

where  a  and  b  are  defined  by  equations  (6-71)  and  (6-72)  respectively. 


(6-81) 

the  inequality  condition 


This  particular  va- 


(6-79) 
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Therefore  a  particular  solution  that  yields  a  stable  inverted 
pendulum  system  can  be  ehosen  by  an  algorithm  as  follows : 

1)  Choose  K4  »  &iK2  where  y  -  . 

2)  Choose  K  such  that  it  satisfies  the  inequality  of  equation 
(6-84) . 

3)  Choose  K,  »  —  K, 

These  steps  should  yield  a  particular  set  of  control  constants 
Kj,  K2,  and  which  produce  a  stable  system,  thus  proving  the  con¬ 
tra..  ability  of  the  inverted  pendulum  system. 

6.6.2  General  Algorithm  for  Computing  Stabilizing  Control  Constants 

A  more  general  algorithm  which  describes  the  procedure  for  ob¬ 
taining  stabilizing  control  constants  can  be  obtained  as  an  extension 
of  the  theory  developed  so  far. 

Choose  K4  *  yK2  where  y  can  now  have  any  value  within  the  limits 
aet  by  the  constraints  of  equation  (6-70).  Then  the  conditions  RQ  >  0, 
Rj  >  0,  and  R3  >  0  are  satisfied. 

The  constraint  R,.  >  0  yields  after  simplification  the  condition 

2 

K3  >  {(b/a)^  -  (mgtb/a)  +  }  (6’85> 

The  condition  R^  >  0  yields  in  this  general  case  the  inequality 
K3  <  tKjU/r)  +  mgij 


(6-86) 
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Therefore  a  general  algorithm  for  finding  the.  control  constants 
that  satisfy  the  Routh-Hurwitz  test  for  the  inverted  pendulum  system 
consists  of  the  following  steps: 

1)  Cuoose  any  value  of  K2. 

a  ^ 

2)  Choose  jj  such  that  -g  <  y  <  ~  • 

3)  Choose  K,  =  yK  . 

4  2 

4)  Substitute  this  value  of  p  into  the  inequality  (6-85). 

5)  Choose  any  values  of  Kj  and  K3  which  satisfy  the  inequality 
constraints  (6-85)  and  (6-86). 

This  algorithm  has  been  programmed  on  a  digital  computer  and  the 
designer  can  get  a  set  of  control  constants  that  satisfy  all  the  condi¬ 
tions  of  the  Routh-Hurwitz  test.  A  listing  of  this  program  is  given  in 
the  appendix. 

6.7  Stabilizing  Control  Mechanisms 

The  general  form  of  the  control  schemes  used  in  the  quadruped  si¬ 
mulation  has  been  discussed  in  Chapter  IV.  In  this  section  the  details 
of  these  control  laws  for  the  different  gaits  are  discussed. 

As  pointed  out  in  Section  6,2,  the  model  reference  control  system 
is  used  for  the  control  of  the  quadruped  t  lation.  The  mode)  used  for 
the  various  gaits  is  assumed  to  be  moving  with  a  constant  velocity  in 
the  desired  direction  of  travel  placing  its  feet  at  predetermined  points 
along  the  way.  This  type  of  an  idealized  walking  system  corresponds  to 
a  "  marching  "  type  of  locomotion  system.  The  model  reference  control 
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system  compares  the  various  translational  and  rotational  components 
the  actual  system  with  the  idealized  model,  and  produces  correction  tor¬ 
ques  and  forces „ 

The  type  of  ecr»trol  laws  used  for  the  quadruped  simulation  have 
been  stated  in  Chapter  IV  and  are  repeated  here. 

The  torque  appli ed  to  the  body  by  the  hip  motor  of  leg  i  is  given 
by  the  relationship 


C  (o . 
o  1 


a  }*-  +  C.u 


(6-87) 


The  lateral  control  torque  is  derived  from  a  centering  spring  and 
a.no  damper  system  and  has  the  form 


Bc  > 
ci 


+  +  C  v 


y'E 


C.v 

y 


(6-88) 


Vertical  control  is  obtained  by  using  the  control  law 


f 


t 

z 


£  )  4-  C»£. 
o'  £  i 


(6-89) 


in  which  the  constant  C  describes  the  effect  due  to  gravity. 

Equations  (6-87)  through  (6-S9)  describe  the  general  type  of 
control  laws  used  in  the  quadruped  simulation. 

For  the  following  cases,  namely,  the  quadruped  postural  system, 
the  quadruped  crawl  (which  is  a  slow  speed  gait  with  no  statically  un¬ 
stable  phases),  and  the  quadruped  walk  (which  has  some  staticallv  unsta¬ 
ble  phases),  the  control  laws  given  above  were  used  with  the  constants 
C* ,  C  ,  and  C.  all  equal  to  z'-o. 

X»  y»  y  1 


For  the  quadruped  trot,  which  is  a  raster  gait  than  either  the 
crawl  or  the  walk,  and  which  has  no  statically  stable  phases,  it  was 
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necessary  to  use  the  general  equations  with  the  lateral  torque  Ts^  de¬ 
pendent  on  both  y  and  y  in  addition  to  the  usual  6  and  8  terms. 

E  E 

For  the  quadruped  pace,  whicK  is  a  faster  gait  than  the  trot, 
and  in  which  the  quadruped  uses  its  legs  on  the  same  side  alternately, 
it  was  necessary  to  incorporate  a  different  type  of  control  law  for 
lateral  control. 

Frcm  equation  (4-124).  the  control  law  U3ed  for  the  inverted 
pendulum  system  is  of  the  form 


T  «  Kj  <|>2  +  K,$.,  +  K,*t  + 


2V2 


3yl 


v4yl 


(6-90) 


As  ’/iewed  from  the  y-z  plane,  the  quadruped  looks  like  an  inver¬ 
ted  pendulum.  Therefore  a  correspondence  can  be  establis;  i  between  the 
inverted  pendulum  system  and  the  lateral  control  mechanism  of  the  qua¬ 
druped.  The  control  law  that  is  u3ed  for  the  lateral  control  of  the 
pacing  quadruped  is  of  the  form 

T  =  J  [K,<J>  +  K2p  +  K3(*+B)  +  K4(p+0)j  (6-91) 

si 

where  Kj,  K2,  K3#  and  are  the  control  constants  computed  for  the  in¬ 
verted  pendulum  system  and  $,  p,  8,  6  are  the  parameters  of  the  quadru¬ 
ped  locomotion  system, 

6.8  Summary 

This  chapter  has  discussed  the  type  of  feedback  control  sys¬ 
tems  as  well  as  the  stability  criteria  used  to  produce  digital  computer 


simulations  of  idealized  stable  quadruped  and  biped  gaits.  For  the 
quadruped  system,  the  modal  matrices  derived  in  Chapter  IV  were  used  to 
obtain  the  characteristic  equation  for  each  mode  after  which  the  Houth- 
Hurwitz  criterion  was  applied  to  get  sets  of  inequality  constraints 
amon  the  control  constants.  Then  the  above  procedure  was  repeated  for 
the  type  of  inverted  pendulum  system  considered  in  this  research. 

Algorithms  were  developed  for  both  systems  to  compute  sets  of 
control  constants  which  satisfied  all  the  constraints  of  the  Routh-Hur- 
witz  test.  Finally,  the  control  mechanisms  used  for  the  various  qua¬ 
druped  gaits  and  the  correspondence  between  the  inverted  pendulum  sys¬ 
tem  control  law  and  that  of  the  quadruped  pace  was  described. 

Chapter  VII  gives  detailed  descriptions  of  the  various  quadruped 
and  biped  gaits,  the  different  vibrational  modes  of  the  quadruped  pos¬ 
tural  system,  and  the  inverted  pendulum  system. 


CHAPTER  VII 


COMPUTER  SIMULATION 


7.1  Introduction 

The  objective  of  th  3  chapter  is  to  present  details  of  the 
digital  computer  simulations  of  the  different  quadruped  and  biped 
gaits  as  well  as  the  results  of  the  application  of  vibrational  analysis 
on  the  quadruped  locomotion  system.  Accordingly,  Section  7.2  d-'iscusses 
the  results  of  the  vibrational  analysis  techniques  used  in  verifying 
the  nonlinear  quadruped  locomotion  system.  Section  7.3  outlines  the 
details  of  the  kinematic  and  dyn  -  ic  parameters  used  to  obtain  stable 
quadruped  gaits  such  as  the  crawl,  the  walk,  and  the  trote  The  next 
section  describes  the  results  of  computer  simulation  of  the  inverted 
pendulum  system  along  with  the  application  of  the  Routh-Hurwitz 
analysis  for  obtaining  stabilizing  control  constants.  Section  7.3 
details  the  application  of  inverted  pendulum  analysis  for  simulating  a 
stable  quadruped  pace.  Finally,  Section  7.6  covers  the  simulation  of 
a  certain  type  of  biped  walk.  This  chapter  contains  only  the  results  of 
the  various  simulations.  The  actual  computer  programs  used  are  listed  in 
the  appendix. 

7.2  Vibrational  Analysis 

This  section  discusses  the  results  of  the  verification  of  the 
nonlinear  quadruped  locomotion  system  simulation  by  vibrational 
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analysis.  The  results  of  Section  3.3  were  used  in  programming  a  non¬ 
linear  digital  computer  simulation  of  the  Quadruped  locomotion  system 
consisting  of  a  mass  supported  by  four  massless  legs.  By  using  differ¬ 
ent  types  of  reference  models  for  the  ideal  quadruped  locomotion  system 
in  this  simulation,  both  postural  control  as  well  as  stable  quadruped 
gaits  were  simulated. 

In  vibrational  analysis,  the  quadruped  was  assumed  to  stand  on  all 
its  four  legs,  with  the  feet  vertically  below  their  respective  hip  socket 
joints.  Figure  6  is  a  photograph  of  the  computer  generated  display  of 
the  quadruped  postural  system.  Figures  7  through  9  show  the  digital 
computer  displays  of  the  vibrational  modes  excited  in  the  nonlinear 
simulation  of  the  quadruped  locomotion  svstem.  These  figures  give  a 
qualitative  idea  of  the  translational  and  rotational  motions  produced 
about  the  x,  y,  and  z  axes  for  the  quadruped  when  postural  system  is 
excited  to  produce  the  various  independent  vibrational  modes.  However, 
a  quantitative  idea  about  the  response  of  the  quadruped  simulation  to 
these  vibrational  modes  is  needed. 

From  the  results  of  Section  4.3  (equations  (4-59)  through  (4-79)), 
the  linearized  system  matrix  is  seen  to  decompose  into  four  smaller 
matrices.  These  matrices  describe  the  dependent  vibrational  nodes  of 
the  standing  quadruped  locomotion  system.  The  following  procedure  is 
adopted  for  the  vibrational  analysis  of  this  system: 

1)  Subroutine  NSEVB  is  used  to  determine  the  eigenvalues  and 
corresponding  eigenvectors  (real  or  complex)  of  the  real, 
nonsymmetric  modal  matrices  of  the  linearized  quadruped 
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Figure  6.  Computer  Generated  Display  of  the  Quadruped 
.  Postural  System. 


Figure  7.  X  Axis  Vibrational  Mode  of  the  Quadruped 
Postural  System. 
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2)  The  small  motion  response  of  the  linearized  system  for  the 
various  inodes  is  then  computed  using  subroutine  LINEAR.  Sub¬ 
routine  LINEAR  computes  the  response  of  the  linearized  system 
for  each  mode  by  perturbing  the  system  using  one-tenth  of  the 
actual  values  of  the  components  of  each  of  the  twelve  eigen¬ 
vectors  (real  or  complex)  of  the  linearized  quadruped  system 
computed  in  step  1  above. 

3)  The  nonlinea-  simulation  is  then  excited  along  each  of  the 
same  twelve  eigenvectors  using  the  same  values  as  in  step  2 
above,  and  its  small  motion  response  recorded. 

Tables  1  through  4  list  the  four  modal  matrices,  their  computed 
eigenvalues  with  error  bounds,  and  corresponding  eigenvectors  for  one 
particular  set  of  control  constants,  namely,  “  9000.0,  =  200.0, 

0B  =*  9000.0,  Cg  *  200.0,  C£  »  1500.0,  C£  »  100.0,  C.  =»  C  *  C-  =  0.0. 

y  y 

Figures  10  and  11  show  the  transient  response  of  the  quadruped 
postural  system  for  certain  x  and  y  axis  modes.  Figures  12,  and  13  des¬ 
cribe  the  response  of  system  to  the  translational  and  rotational  motions 
of  the  z  axis  modes  respectively. 

Table  5  is  a  sample  of  the  linear  system  response  when  the  system 
is  excited  along  the  first  eigenvector  of  the  x  axis  modal  matrix  given 
in  Table  1.  Table  6  gives  the  response  of  the  nonlinear  quadruped  sys¬ 
tem  for  the  same  excitation. 

From  the  transient  response  of  the  quadruped  postural  system  to 
the  different  vibrational  modes  (Figures  10  through  13),  as  well  as  from 
the  sample  sets  of  data  given  (Tables  5  and  6),  it  is  seen  that  the  non¬ 
linear  and  linearized  quadruped  system  responses  agree  to  within 


TABLE  1 


Modal  Matrix,  Eigenvalues,  and  Eigenvectors 
for  the  X  Axis  Vibrational  Modes 

DIFFUSIONS  OF  500V 

As  ?.50  R*  1. 00  C*  0.25  LENGTH*  3.00  FASS*20.Q0 
FOMENTS  OF  INERTIA 

1 XX*  7.0833  IVY«42.0833  IZZ-48.3333 

CONTROL  CONSTANTS 

f  A*  O000.0000  OCA*  700.0000  CB*  9000.000u  OCB*  200.0000 

CL*  1500.0000  DCl*  100.0000  OCX*  0.0  CV*  0.0 

ncv*  o.o 

♦•X-AXT8  TR ANSI ATT ONAL  t  ROTATIONAL  FOG At  MATRIX** 


0.0 

-1*9. 766663 
O.n 

-307.635698 


1.000000  0.0 

..6,666664  -647.316650 

0.0  0.0 

-6.864691  -1890.905273 
COMPUTED  FISFNVALOES 


0.0 

-14.444446 
1.000000 
-Rl. 716187 


NO.  RFAt  FART 
1  -2.140625954 

7  -7,140678954 

3  -40.939687007 

4  -40.939687007 


INAG.  FART 
8.860431671 
-8.860431671 
15.313523293 
-15.313573793 


ERROR  SOUND 
0.000393874 
0.000393874 
0.002375914 
0.007375914 


COMPUTED  EIGENVECTOR  N0.«  1 


REAL  FART 
-0.025767886 
l.OOOCOOOOO 
0.007656877 


IFAG.  FART 
0.106637120 
0.0 

0.016778924 


ERROR  ROUND 
0.000002869 
0.000020361 
0.000004073 


-0.165058970 


0.031925749 


0.000126384 


)BW^ 


TABLE  1  Continued 

COMPUTED  EIGENVECTOR  N0.«  2 
SEAL  PART  (MAG*  PART  ERROR  BOUND 

-0.025762**6  0.  '0663712D  0.00000236*) 

1.000000000  0.0  0.000020361 

0.00765687?  -0.016778924  0.000004073 

-0.165058970  -0.031925749  0.000126384 

COMPUTED  EIGENVECTOR  ND.»  3 
REAL  PART  f MAG.  PART  ERROR  POUND 

-0.001992267  0.001950445  0.000002378 

0.05164%544  -0.11035919?  0.0000250  .VJ 

-0.021428082  -0.008015189  0.000001025 

1.000000000  0.0  0.000003253 

COMPUTED  EIGENVECTOR  N0.«  4 
REAL  PART  I MAG.  PART  ERROR  BOUND 

-0.001992267  -0.001950445  0.00000233* 

0.051694594  0.110359192  0.000025075 

-0.o?s4?Sf!S?  0.008015189  U.000001025 

1.000000000  0.0  0.000003253 

LARGEST  RSSIOUALO. 4580798180-01 
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TABLE  2 

Modal  Matrix,  Eigenvalues,  and  Eigenvectors 
for  the  Y  Axis  Vibrational  Modos 

ni  of  sou* 

A*  2.50  S*  l.Of*  C*  0.25  IFNGTtt*  3.00  *  ">20.00 

KPHFNTS  OF  INFRTtA 

1XX*  7.0*33  1W.42.OS33  W7-4B.3133 

CONTUni.  CONSTANTS 

CA«  <1000.0000  OCA*  *00.0000  CO*  <>000.0000  oca*  200.0000 
ct»  isoo.oooo  net*  .  too. oooo  ncx*  n.o  r.v*  o.o 
ncY*  o.o 

••V-AXIS  TRANSLATIONAL  t  ROTAT I0NAL  “OOAL  HATRfX** 


0.0 

t. 000000 

0.0 

0,0 

1*9.766663  -4.444444 

447.316650 

14.444444 

0." 

o.o 

0.0 

i. ooooon 

S3  7. 71 §750  40.7*4332 

-6787.140425  - 

139.019684 

COePUTFD  FtGENVALUFS 

VO. 

SFAl  FART 

{NAG.  FART 

ERROR  ROUND 

1 

-0.7454*4173 

3.754101753 

0.000611827 

2 

-0.7454*41 73 

-3.754101753 

0.000611877 

3 

-4*. 164316902 

0.0 

0.009812821 

4 

-143.8082477919 

0.0 

0.010169104 

CONFUTED 

FT6ENVFCT0R  MO. 

*  1 

RFAl  PART 

I MAG.  FART 

ERROR  BOUND 

-0. 0508*9463 

-0.256269693 

0.000021063 

*.000000000 

0.0 

0.000012168 

-0.015198353 

-0.069005013 

0.000011929 

0.270382166 

-0.005614769 

0.060364130 
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TABLE  2  Continued 


COMPUTED  EIGENVECTOR  NO,« 


REAL  PART 

TMAG.  PART 

-0.'’  -663 

0. 266269693 

1 .OonOOOOOO 

0.0 

-0.015198666 

0.069005013 

0.270382166 

0.006614769 

COMPUTED 

EIGENVECTOR 

REAL  P ATT 

T MAGs  PART 

0.000437836 

o.o 

-0.Q2V088269 

0.0 

-0.020761997 

0.0 

1.030000000 

0.0 

COMPUTED 

EIGENVECTOR 

REAL  PART 

f MAG.  PART 

0.000491486 

0.0 

-0.070679646 

0.0 

-0.006963701 

0.0 

t • OOnGOuuOO 

At 

UA*» 

7 

ERROR  ?ntJM0 
0.000021063 
0=000012168 
0.000011926 
0.000364130 

t  3 

FUROR  ROUND 
0.000006041 
0,000023614 
0.000302083 
0.000107286 

*  4 

FRROR  BObHO 
0.000001752 
0.000007792 
0.000002673 
0.000107767 
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TABLE  3 

Modal  Matrix,  Eigenvalues,  and  Eigenvectors 
for  the  Z  Axis  Translational 
Modes  of  Vibration 

DIMENSIONS  OF  RflDY 

A*  2.30  U00  C»  0.2*5  LFNGTH*  3.00  MASS*20.00 

MOMENTS  TIF  TNFRTIR 

TKX«  7.GR33  IYY«A2.0833  t??*AR.3133 

CONTROL  CONSTANTS 

CA*  OOOO.OOOO  OCA*  200.0000  Cfi*  0000.0000  OCR*  200.0000 

cl*  1300,0000  ocl *  ioo.oooo  nr.x*  o.c  cv*  o.o 

ncv*  o.o 

••7-AX  IS  TRANSLATIONAL  MODAL  MATRIX** 

o.o  i.oooor.o 

-300.000000  -20.000000 

Cn-FIJTFO  FIC.FNVAIUFS 

NO.  REAL  RT  !NAG.  FART  ERROR  BOUND 

1  -lO.OC's  tr  >000  14.1*2133320  0.000031282 

2  -10.000000000  -14.1 4213SA20  0.000031282 

CONFUTED  EIGENVECTOR  N0.«  l 
•>f Al  FAR?  i*AG.  PART  ERROR  ROUND 

-0.03333333!  -0.04T1404S3  0.000000083 

I • 000000000  0.0  0. OaOvOuGoO 

COMPUTED  F I GFN VECTOR  NO.*  2 
RFAL  PART  IMAG.  P.i*T  ERROR  BOUND 

-0.033333331  0.047S40433  0,000005083 

1.000000000  0.0  0,000000000 


LARGEST  Ff$!0UAt*0.317g«»*i3<?O-0e 
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TABLE  4 

Modal  Matrix,  Eigenvalues,  and  Eigenvectors 
for  the  Z  Axis  Rotational 
Modes  of  Vibration 

dimensions  of  ntinv 

7.50  0*  1.00  C«  t  FNGTH-  ».f>0  MASS-20.00 

MOU  NTS  OF  1NFRTIA 

IXX*  7.00V)  !YV*42,0 R33  t?2-40.3333 

cnNT2.ni  constants 

ca»  oooo.oooo  oca*  ?oo.nooc  c«=  9000.0000  dcb-  200.0000 
rt*  isoo.oooo  oct*  100.000&  or. x-  0.0  rr-  0.0 
nrv*  0.0 

AX  f  S  »0T»T  l ONAL  MODAL  MATRIX** 

0.0  l. 000000 

-667.000049  -13.333341 

COMPUTED  FIGFNVALUFS 

NO.  RFAl  "AST  t MAG.  PART  ERROR  BOUND 

l  -6.666671703  2?.  07696830',  O.COO1O07O6 

'/  -6. 666671743  -22.M76960304  0.000108706 

COMPUTED  EIGENVECTOR  NO.-  1 
REAL  PART  IMAG.  PART  ERROR  BOUND 

-0.011 741220  -0.040290616  0.000000096 

1.000000000  0.0  0.000009000 

COMPUTED  EIGENVECTOR  MO.-  2 

real  part  inag.  part  error  bound 

-9*01 1741225  0. 040290*16  0.000000096 

1.000000000  0.0  0.000 00 GO 00 


J.ARGFST  RESTOUn-0. 2692896160-07 


Figure  10.  Transient  Response  for  a  Particular 
X  Axl^t  Vibrational  Mode. 


Figure  11.  Transient  Response  for  a  Particular 
Y  Axis  Vibrational  Mode. 


Figure  12.  Transient  Response  for  a  Particular  Z  Axis 
Translational  Vibrations’,  Modv, 


Transient  Response  for  a  Particular  Z  Axis 
Rotational  Vibrational  Mode. 
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Linear  System  Response  of  the  Quadruped  Locomotion 
System  for  a  Particular  X  Axis 
Vibrational  Mode 

DIMENSION*  OF  BODY 

A*  2.50  B«  1.00  C*  0.25  LENGTH*  3.00  ttASS*20.00 

FOMENTS  OF  INERTIA 

1XX*  7. OS 33  IYY=42.0333  122*48.3333 

CONTKUL  CONST  ANT S 

C  A  =  9000.0000  OC  A=  200.0000  CF=  9000.0000  0C6“  200.0000 

CL*  1500.0000  OCL*  10C.0000  OCX*  0.0  CY«  0,0 

OCY*  0.0 

**X— AXl S  TRANSLATE  NAL  E  ROTATIONAL  MODAL  MATRIX** 

C.O  i. 0000^0  0.0  0.0 

-18°. 266563  -A. 4*4444  -64T.31b650  -14.444444 

O.0  0.0  0.0  1.000000 

-307.635498  -6.864091  -1*90.905273  -81.716187 

COMPUTED  fc I GENVALUE  S 

NU.  HFAL  PART  l MAG.  PART  ERROR  BOUND 

1  -2.140625954  H.P60431671  -l. 000000000 

2  -2.140625954  -8.860431671  -1.000000000 

3  -40.939682CC7  15.313523293  -1.000000000 

4  -40.939682007  -15.313523293  -l. 000000000 

COMPUTED  EIGENVECTOR  NO.*  1 
REAL  PART  IMAC.  PART  ERROR  BOUND 

-0. Of j! 64219  -0.106632531  -1.000000000 

0.999999940  -0.000000000  -1.000000000 

0.007656947  0.016776852  -1.000000000 

-0.165051877  0.031954452  -1.000000000 


TABLE  5  Continued 


compute'’ 

REAL  PART 
-0.0,?  57  6*2  IS 
0.999999S40 
0.0076569*  7 
-0. 165051877 

COMPUTE, 
REAL  PART 
-0 . OC  5  98999* 
0.051681  701 
-0.021*27996 
0.999999881 

COHPUTFI 
REAL  PART 
-0.00,98999* 
0.051681701 
-0.021*27996 
0  999999881 


riGENVFCTOO  Nfi.= 
IM&G.  PART 
0.K66  125  11 
9.r>V)000000 
-0.016776852 
-0.01195**52 

I  EIGENVECTOR  NO. 
1  MAG.  PART 
0.001950331 
-C. 110332*29 
-0.00 PC  1 31 31 
C. 000000000 

)  EIGENVECTOR  NO, 
I MAG.  PART 
-0.0C195033 1 
9.  110332*2° 
0.008013181 
-0.000000000 


LARGEST  RES  1 0UAL»0. 5  580797 190-01 


£ I  GEN VALUE 

ALPHA*  -2.1*06?6C  ONEGA*  8,860*317 


0. 1*CQMPUTED  EIGENVECTOR  NO.*l 


REAL  PART 
-.2576*21016-02 
0.9999990*&E— 01 
0.7<  >69*3056' 03 


I  NAG.  PART 
-  *  106632486E-01 
-. 35527 12* IE- 15 
0.167768**96-02 


2 

ERROR  BOUND 
1.000000000 
1.000000300 
l. 000000000 
1.000000000 

3 

ERROR  BOUND 
1.000000000 
l. 000000000 
1.000000000 
1.000000000 

:  * 

ERROR  BOUND 
■1.000000000 
ooooooooo 

•l.OOOOCOOOO 

-1,000000000 
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TABLE  5  Continued 


».  IK«-  ftK  svs  It  m  «l  SPt'NSL 


r  t*tr 

X 

t 

a 

H 

0.0 

-i)  .00247  64?  1 

0.054999905 

0.  noc 7656  94 

-C. 016505182 

0.  1000 

0.008  35  23  3  I 

r.osi06L'0,t9 

-0.0006581 13 

-C. 01042571 7 

0.2000 

0. 007144944 

-o.os  39 1')??  r 

-0.001171093 

C.000li0147 

0. *coo 

0.003803158 

-0,0468«3874 

-9.00076 7011 

C. 006907232 

0.4000 

-0. OCO  76  76  71 

-.3.1  34079394 

-0. 000020037 

0.006981898 

o.sooc 

-0. ''03265847 

-9.00954  7H48 

0.000479422 

0.002628280 

0.60C0 

-0.002834774 

0.015719896 

0.000502646 

-C. 001366303 

0.7000 

-0.000766429 

9.022274811 

0.000200849 

-0.003618805 

0.8000 

0.001064826 

0.C12502614 

-0.000122481 

-C. 0024 79206 

0.9000 

0.C015869C8 

-0.901749458 

-0.000255978 

-C.0001 73288 

l .coor 

0.0009265  75 

-0.C099i4880 

-O.OOC 18 1580 

0.001438810 

1.1000 

-C.0.10088009 

-0,099005375 

-0.000018603 

0.001582257 

1 .2000 

-0.000693757 

-0.092721440 

0.000099345 

C. 000678088 

l .300C 

-C. 00065 11  OP 

0.CO3069895 

0.000113575 

-0.000338732 

l  .  .00 0 

-0..  TOO?  12770 

0.094929077 

0.000051237 

-C. 000787850 

1.5000 

0. 000207066 

n. 00 3019786 

-0.000021697 

-0.00058378  7 

l  .6000 

0. '>00350123 

-0. C 00128596 

-0.000055549 

-0.000082703 

1 .7000 

0. 000222596 

-0.002 099423 

-0.000042587 

C. 00029601 8 

1 . 8000 

-0.000000869 

-0.OC2060126 

-0.000007287 

0.000356193 

t .9000 

-0.P00145960 

-0.000735557 

0,000020314 

C. 000170824 

2.0000 

-0.000148489 

0.000591496 

0.000025494 

-C. 00005769 7 

2.1000 

-0.0C0056512 

C. 001083416 

0.000012795 

-C. 000170250 

2.2000 

C. 000039065 

0.000720897 

-0.000003549 

-C, 000136258 

2 . *000 

0. OC  0076724 

0.000030084 

-C. 00001 1963 

- C. 000028189 

2 .8000 

0. OOQ05289C 

-0.000439108 

-0.000009904 

C. 00006001 6 

2.5000 

0.000004008 

-0,000468023 

-0.000002317 

C.00CQ79660 

2.6000 

-0.000030377 

tO. 000191  769 

0.000004088 

C. 000042235 

2 .7000 

-0.000033633 

0.0001 09 192 

0. 000005685 

- C. 000008786 

2 .8000 

-0.000014549 

0.C902  364  87 

0.00000314J 

-0.00003649  8 

2 .9000 

0.000007062 

0.0001 70339 

-0.000000497 

-0.000031546 

3.0000 

0.000016694 

0.,  000019824 

-0. OOOOC2555 

-0.00000842  B 

3.1000 

0.0O0012445 

-  0, 00009C770 

-0.0000022 85 

C. 0000 11953 

3.2000 

C. 000001829 

-C . TOO  105614 

-0.000000668 

C. 000017699 

3.3000 

-C. 000006243 

-C. 000048697 

0.000000807 

C.,  0000 10284 

3  .4000 

-0.000007568 

0.000019103 

0.000001259 

-C. 000001033 

3.5000 

-0.000003659 

0.000051245 

0.000000760 

-0.000007757 

3.6000 

0.000001195 

0.000039882 

-0.000000044 

-C. 000007249 

3 . 7000 

0.000003605 

0.000007329 

-0.000000541 

-0.000002347 

3 .8000 

0.000002003 

-0.000018508 

-0.000000523 

0.000002328 

3 .9000 

0.000000615 

-0.000023676 

-0.000000182 

0.000003906 

4.0000 

-0.000001264 

-0.000012116 

O.OOOOOCl 55 

0.000002472 

4.10CC 

-0,000001602 

0.000003057 

0.000000277 

-O.OOOG00021 

4  .20  CO 

-0.000000904 

0, 000011019 

0.000000182 

-C. O666OI 63 3 

4.3000 

0.000009180 

0.000009260 

0.000000005 

-0.000001654 

4.40C0 

0.000000772 

0.000002275 

-6.606600113 

-0.000000625 

4.50C0 

0.000000672 

-0.000003T12 

-0.000000119 

C. 000000440 

4.60C0 

0.000000182 

-0.000005273 

-0. 060600648 

0.666000856 

4.7000 

-0.000000251 

-0.000002966 

0.000000029 

0. 000000588 

4.8000 

-0.000000376 

0.000000403  ' 

0.000000061 

0.000000042 

4.9000 

>0.000000220 

0.000002349 

0.000000043 

-0.000000340 

S.0000 

0.000000020 

O'.  OOOOOa  3  3 

6.656666564 

-0.00^000375 
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TABLE 

5  Continued 

9 .1090 

0.909000164 

o„ 99000064 7 

S .290C 

0.909009194 

-  9 . 000900  729 

8.3000 

C. 000009091 

-0.999901 167 

9. 4000 

-0.0C000004O 

-C. 090000716 

8 .9900 

-D. 99900008 3 

0.00L-000029 

9 .6000 

-0.000090093 

0.0900C0496 

9.7000 

0.090090000 

000009488 

9 „ 9000 

9.900000938 

9.000000179 

9.9000 

0.000000038 

-9.000900140 

6 .0900 

0.000000913 

-0.09900028b 

6.1900 

-0.000000009 

-0.900000171 

6.2000 

-9. 990000018 

-9.090000007 

6.3000 

-0.000000013 

0 .900000 1 04 

6. 4000 

-0.  "<00000001 

0.900009H  1 

j  .9000 

0.900000097 

0. 090000046 

6  .6000 
6.7000 
6 . 89C0 
6.0000 
7.0000 

7.1000 

7. ?000 
7.3O00 
7.4000 
7.6000 
7.6000 

7.7000 

7. 8000 

7.9000 
9  .0000 

8 .1000 

8.  *000 

'  3000 

b  .*000 
8  .8000 
8  .6000 

8.7000 

8 .8000 

9.9000 
9.0000 
9.1000 
9.2000 
9.3000 
9.4000 
9.9000 
9.6000 

9.7000 
9.8000 
9.9000 


0. 9C0C90008 
0.000000003 
-0.000000002 
-0 .990000004 
-0.000000003 

-o.orocoooco 

C.COCOOCOOl 
0. 100000002 
0.  '>00000001 
-0. 000000000 
-O.OOOGOOOOl 
-0.900000001 
-O.OOOOOOOOO 
O.OCOOOOOOO 
0.000000000 
9.000000000 
-c.ornoooooo 
-0.000000000 
-0. oooooooo ) 

-0. OCOOOOOO  '• 
0. 900000000 
0.900000000 
0.090009000 
-0.000000900 
-0.900000000 
-0.000000000 
-C. 000000000 
CoOOOOOOOOO 
0.000000000 
0.000000000 
-0.000000000 
-0.000000000 
-0.000000000 
-o.ooooooooo 


-9.990000086 
-0.CO9OCO049 
-0.9000C0005 
9.000000021 
9.C0090C028 
0.000000012 
-O.C 00000 004 
-9.09000001? 
-9. 00 9000 009 

-o. oooooooo? 

'<.000000004 

9.00000000b 

9.0000:10003 

-O.OOOCOOOOl 

-0,090000001 

-9.000000002 

-O.OOOOOCOOl 

0.00000000* 

O.OOOOCOOOl 

0.090000001 

-  0. coooooooo 

-9.000000001 
-0.000000001 
-o.ooooooono 
0.000000000 
0.00  000000 
0,000000000 
-0.000000000 
-o.ooooooooo 
“0. 000000000 
-0.000000000 
C.00000C030 
0.000000000 


-0.000000023 
-0. 000000027 
-9.000000012 
0.000000005 
C.  0000000  13 
O.OOCOOOOIO 
0. OOOOOOOO 2 
-0.000000009 
-0.000000006 
-0.000000003 
0.000000001 
0.000000003 
0.000000002 
9.000000001 
-0.000000001 
-0. 000000001 
-0 • 000000001 
0.000000000 
0. UUOOOOOOl 
0.090000001 
0.000000000 
-0.000000000 
-0.000000000 
-0.0000009 JO 
0.000000000 
0.000000000 
0.000000000 
0.000000000 
-0.000000000 
-o.ooooooooo 
-0.000000000 
-o.ooooooooo 
0.000000000 
0.000090000 
0.000000000 
-0.000000000 
-o.ooooooooo 
-0.000000000 
-0.000000000 
0.000000000 
0.000900000 
0.09  w. 00000 
-0,000000000 
-0.000000000 
-o.oqqoqoooc 
-6,000000000 
0.000000000 
0.000000000 
0.000000000 


0.000000161 
0.000000080 
C. 000000186 
C. 000000138 
C. 000000020 
0.000000070 
C. 000000084 
C. 000000041 

C. 00000001 4 
C.000CQO040 
C. 000000032 
0.000000007 
-0.000000014 
-C. 00000001 9 
-C. 000000010 
C. 000000002 
0.000000009 
C. 000000007 

c. oooooooo? 

-C. 000000003 
-  C.  COOOOOOO-4 
-C. 000000002 
0.000000000 
c. oooooooo? 
0. 000000002 
0.000000001 
-C. 000000001 
-0.000000001 
-C. OOOOOOOO l 
C.OOOCOOOOO 
0.000000000 
0.000000000 
c.000000000 
-0.000000000 
-C.000000000 
-0.000000009 
-C.000000000 
c.000000000 
0.000000000 
0.000000000 
-0.000000000 
-C.000000000 
-C.000000000 
-C.000000000 

c.oocoooooo 

o.ooooooooo 

0.000000000 

-o.ooooooooo 

-0.000000000 


OUTPUT  COMSTARTS 


TABLE  6  Continued 


X-AXIS  MODE  NO.t 
PRINTED  OUTPUT  FORMAT 


time  *  x  »  ; 

tl.cai»  -P.0?247*3  0.099782199  ?.O0*7<9l84  -0,016498180 
6.1000  «\0;«S3V72o  0 .0^1 059124  -0,0006582*3  -0. 0104241.54 
0.2080  0.00714*131  -0,013031146  -0,001171211  0,000112243 
0.3080  S'.003a’f0l5  -0.046583465  -0,800767025  0,006908264 
0.4000  -0,0007t7939  -0 .*39077571  -0,008019971  0,286901428 
0.5000  -/.Priat  5963  -2.089545999  0,000479492.  8,002627361 

O, 6000  '■0.002834663  2,01*719448  2,020*02663  -0,001867219 
?.7002  -2.2/i’7no21*  0.022273673  0,000200817  -0.0036X8858 

2.8000  0/1004900  0.012580891  -0.800122523  -0.002478636 

P. 9022  7.821*oo879  -0.O0i?5O546  -0.800255996  -0,000172668 

1.8000  0,30090*436  -0.029934722  -9.000181568  0,001439096 
1,1030  -.J,.800/n,lj8  -2,309024254  -0,000018575  0,001*82059 
1.2800  -0.3(006  ;  *781  -0,002720371  0.800099362  0,008677710 
1.300?  -2. 00^6*1036  0.003090249  3.000113573  -0.300339?O? 
1.403E  -3,03321 267  7  3,004928619  9. 008051223  -0,000  7-17959 
1.5000  2,0322. 7 1* 6  P. 003819044  -0.000821709  -0,080583583 
1.6000  r. 03.J3*. *99  -8.060129875  -8.808055552  -8,888082574 
1.7000  0, 02327/539  -0,002899347  -8.088342503  9,803296082 
1.8800  -3.323/'.  912  -3.082859712  -0.808657278  0,8*0356113 
1.9010  -2.032146695  -0.000719915  0,008820407  8.868168285 
2.0010  -0.000147867  0.880601381  0.808825434  -0.880059628 
2.1012  -C.3C30**?0»  0.081083270  9.888*12619  -8.888170562 
2.201?  Z.3330.XO795  8. *88714327  -0. 088063657  -8.800135313 
2.3810  0,002076741  0.880023434  -8.8*8*11990  -0.808027013 

2.4810  0.3300*7430  -3.000441566  -8.88*809841  0. *8*360611 
2.5018  0.0032 *353?  -8.888466289  >8.880902235  0.890079456 
2.6810  -0, 03033256V  -8.888189358  8. *08884130  8.800041681 
2.701?  -0.803333515  9,880111571  8.88*805675  -0,888009236 
2.8010  -3.803014334  8.8*8236637  8.800803103  -9,888036576 
2.9610  «?,8P3?.'7236  8,088168967  -*,***»8«335  -0,888831361 
3.0810  3.02eOi6711  8,80881825*  -8.88^82563  -8,088008205 
3.1818  0,8020 1 2345  -8.801891436  -0,t*#00?27?  0.9*8012195 
3.281*  0.8802P1713  -0.889105323  -f.Sfffff**?  9.008817646 
3.3*18  -9.008006390  -0.8*8847934  8. 80 88 8*81 9  8. 80881*169 

3.4810  -0.0e00.’755l  0,080019741  8. 000881257  -8.008*01168 
3.50l«  -0.80*8/339*  «.0t0»51454  8.008008751  >0tG0300’775 
3.6010  8, 0068-71252  0.00883*558  -8. 6« 00*6 85 4  -8,088887226 
3, '*910  8,088??.36l9  0.000806059  -0,80 80 08545  -0,080002282 
3.0010  8.8098P2874  -0. 090016806  -0.000000520  0, 005003378 
3.9018  8,000000574  -0,000022415  -0.000400175  0,000003912 
4.0018  >*.8*0301206  -9.S086U05*  0,3*60*0169  0,89*812427 
4.101*  -0, *80081687  8.0009*3221  0,00*006278  -6, 00*4091 89 
4.201*  -f,  090800002  0*000011196  0,00*000129  «9,HS7itH5 
4,3*10  0.0*00*9199  0.000 00 0100  e,WMNMI  -8,80*001488 
4.4010  0. 089808776  *(*(000>U6  -9, 6869  fill*  -0,00*#*9M5 
4.5910  0. 868**8 66#  -0,000002046  0.000*0047* 
4.6*00  0,000990192  •I.NfURff  -0.  0,00*020045 
4,7000  -», *#3000240  -«.###•# 0043  0,0000 00 927  9, 80000ft*? 
4.6089  -0. 000800871  0,000000000  0,099000961  -0,0*0080022 


TABLE  6  Continued 


4e 9900 

•0. 2030/3223 

0.202002163 

8.280000847 

-0,000000429 

$.9000 

£.  0000.-7.0?  3 

2.000002016 

0.080208013 

-0,000020192 

5.1000 

0.0000/31*3 

/. 000000568 

-0.060000022 

-0.600000*02 

5.2000 

0.0000/0146 

-0.000000425 

-6,008800027 

0,000000135 

5, 3f00 

0,0800«*e066 

“0.000000907 

-0.000000022 

0.000000069 

5.4800 

0.000000003 

-0 .000000496 

-ft • 020000012 

0.000000042 

5,5300 

-0,00003/838 

“0.000000334 

-8,000080009 

0.000000029 

5.6800 

-8,0000000 62 

•0.000000003 

-8.000008^03 

0,000800204 

5.7C09 

•  0 , 0800/'/04  6 

0.000300124 

3,000006004 

-0,0000000 15 

5. sees 

-8.800003038 

0.000000886 

0,000900003 

-0,000000015 

5.9001 

-f. 800033030 

0,000000063 

0.000006001 

-0 ,000009215 

6.0001 

-0.0000/3024 

8,800000060 

-0.000080000 

-0,000800015 

6.1001 

•0,000033016 

0.000006856 

-0,000000002 

-0 ,000000015 

4.2001 

-0,0008/0012 

0,000000061 

-0.900088003 

-0,000000015 

6.3001 

-0,000033004 

0,000008067 

•0.000000005 

-0,000000815 

6.4001 

0.000033001 

2 .000890974 

-0,000000006 

-B , 0080000 1 5 

6.5001 

0,00033.1009 

0.000000093 

•0.008000006 

-0.000000/15 

6.6001 

0.0900?3gl6 

0.000000093 

-0.000003009 

-0,00000001*’ 

6.7001 

0.090003827 

0.008900193 

-0.000000011 

-0,000000015 

6.6001 

2.088030038 

0.000000113 

•0,000000012 

-0,000000015 

6.9001 

0,009033050 

0.000200124 

-0,000000014 

-8 ,00000* i 15 

7.0001 

0.006033 368 

-0.008000093 

-0.000000018 

•0,00006^194 

7.1001 

0,008033063 

0.008808056 

-0.000800020 

-0,000000 015 

7.2001 

8.0080330 71 

0.080000108 

-0.000000821 

-0,0006003-5 

7,3001 

0.80003. 804 

2.000000144 

-0.000000023 

-0 ,000303015 

7.4001 

0. •60088065 

•0,060800150 

-0.000000022 

0.003300035 

7.5081 

0,009838074 

-0.090000068 

•9.000000021 

e, 00000001? 

7.6081 

0.009033071 

-0,000000005 

•0.000000019 

0 , 0000600 1 5 

7.7001 

9.090033073 

0.990000034 

-0,000008019 

-0,000000011 

7,6891 

0.000088079 

0.008090005 

-0.000008020 

-0,000000013 

7.9091 

Sc  09082/889 

0,000800126 

-0. 000800821 

-0 ,00003*4015 

8.8901 

a. 86 0033082 

-0.020000004 

-8.086900821 

0,000000015 

8,1001 

■*.00*033077 

-0.000098018 

-0.000880820 

0.008000015 

$.2801 

0.2500/8076 

8,800800826 

•8,003980819 

0.800000005 

8.30C1 

0.008033892 

0,600009367 

-S.0»£0S8B19 

-0.890000007 

6,4801 

0,6000/2899 

-0.000680046 

-*,80eOSS02? 

-0,808000165 

8.5001 

2. £00830056 

•8,600880610 

-8.800000022 

8  ,699880015 

3.6091 

0. £6303358? 

8,368900041 

-0.008930021 

0,029088001 

6.7001 

0,088632080 

“5.080002019 

-3.9006*0023 

0,090820015 
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one  part  .in  106  for  ..mall  motions  about  the  equilibrium  point.  This 
proves  the  validity  of  the  nonlinear  simulation  of  the  quadruped  loco¬ 
motion  system  as  well  as  that  of  the  linearization  scheme. 

7.3  Simulation  of  Quadruped  Gaits 

This  section  describes  the  simulations  of  quadruped  gaits  such  as 
the  crawl,  the  walk,  and  the  trot.  As  mentioned  in  Section  7.2,  the  non¬ 
linear  equations  of  motion  of  the  quadruped  have  been  programmed  into  a 
digital  computer  simulation  which  displays  the  various  gaits  on  a  cathode 
ray  tube  display  system  connected  to  the  computer.  For  producing  stable 
gaits,  the  model  reference  type  of  approach  discussed  in  Chapter  VI  is 
used.  The  ideal  kinematic  reference  model  is  assumed  to  walk  in  a 
straight  line  with  constant  velocity,  placing  its  feet  periodically  at 
precomputed  points  a  stride  length  apart  along  the  direction  of  motion, 
namely  tha  positive  x  axis. 

Hie  kinematic  model  for  each  gait  is  described  by  the  following 
parameters: 

1)  The  duty  factor  -  the  relative  amount  of  time  spent  on  the 
ground  by  each  leg  during  one  locomotion  cycle. 

2)  The  relative  phase  -  the  amount  by  which  the  motion  of  leg  i, 
i  -  2,  3,  4,  lags  behind  that  of  leg  1  expressed  as  a  fraction 
of  the  time  required  to  complete  one  locomotion  cycle. 

3)  The  stride  length  -  ths  constant  distance  by  which  the  body  is 
translated  in  one  complete  locomotive  cycle  of  the  gait. 

4)  The  period  -  time  required  for  one  complete  locomotive  cycle 


of  the  gait 
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5)  The  initial  foot  position  for  lag  i  -  che  coordinates 
(*±l  Yi}  *£>  of  the  position  of  the  foot  of  leg  i  at  the 
reference  leg,  namely  leg  1  first  touches  the  supporting  sur¬ 
face  in  any  locomotion  cycle.  These  coordinates  are  measured 
in  the  body  fixed  coordinate  system  x,y,z  with  its  origin  at 
center  of  gravity  of  the  locomotion  system. 

6)  The  desired  z  coordinate  of  th>s  body  -  the  constant  height  of 
the  center  of  gravity  of  tlie  ideal  kinematic  model  of  the 
locomotion  system  above  a  horizontal  plane  supporting  surface 
on  which  the  reference  model  walks  in  a  straight  line  in  the 
direction  of  motion  with  its  legs  cycling  periodically  in  both 
space  and  time. 

The  ideal  kinematic  model  for  each  quadruped  gait  is  specified  by 
the  above  parameters. 

In  the  computer  simulation,  simple  linear  feedback  control  laws 
based  on  the  difference  between  the  actual  and  desired  values  of  leg 
lengths,  angles  and  their  time  derivatives,  are  used  to  obtain  stable 
gaits.  The  simulation  of  the  various  quadruped  guits  is  considered  in 
greater  detail  below.  For  each  case,  a  general  description  of  the  gait, 
a  list  of  the  kinematic  and  dynamic  parameters  used,  as  well  as  a  photo¬ 
graph  of  the  computer  display  is  given.  During  any  phase  of  the  locomo¬ 
tion  cycle,  legs  which  are  off  the  supporting  surface  are  not  displayed. 
7.3.1  The  Quadruped  Crawl 

This  is  a  slow  speed  gait  during  which  the  quadruped  has  alterna¬ 
tely  either  three  or  four  legs  on  the  ground  at  all  times  during  a  loco¬ 
motion  cycle.  All  the  phases  of  this  gait  are  statically  stable  because 
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the  center  of  gravity  of  the  body  is  within  the  ”  support  pattern  "  [16] 
at  all  times.  Therefore  this  gait  is  easily  stabilized.  The  crawl  gait 
is  thus  well  suited  for  low  speed  locomotion,  .*,  preferred  by  natural 

quadrupeds  as  well  as  animals  with  more  than  four  legs  for  low  speed 
terrestrial  locomotion. 

Figure  14  is  a  photograph  of  the  computer  simulation  display  out¬ 
put  of  the  quadruped  with  all  its  four  legs  on  the  ground  at  the  begin¬ 
ning  of  its  crawl  gait  cycle.  Table  1  lists  parameters  for  the  crawl. 

7.3.2  The  Quadruped  Walk 

This  is  a  faster  gait  during  which  the  quadruped  employs  alter¬ 
nately  three  and  two  legs  for  its  support.  During  the  fraction  of  the 
locomotion  cycle  when  there  are  only  two  legs  on  the  supporting  surface, 
the  quadruped  is  statically  unstable.  The  parameters  used  for  the 
simulation  of  this  gait  are  listed  in  Table  8,  and  a  photograph  of  the 
quadruped  at  the  beginning  of  its  locomotion  cycle  while  performing  the 
walk  is  shown  in  Figure  15. 

7.3.3  The  Quadruped  Trot 

This  is  a  higher  speed  gait  that  quadrupeds  employ.  While 
trotting,  the  quadruped  uses  alternately  diagonally  opposite  pairs  of 
legs  to  support  itself.  Therefore,  this  gait  is  characterized  by  the 
fact  that  all  its  phases  are  statically  unstable.  Dynamic  stability  of 
the  quadruped  during  a  trot  gait  is  more  difficult  because  it  is  nece¬ 
ssary  to  incorporate  feedback  terms  proportional  to  the  bod’  transla¬ 
tional  velocity  normal  to  the  nominal  direction  of  motion.  Thus  terms 
proportional  to  y^  and  y^  were  needed  to  stabilize  this  gait. 

Table  9  lists  tha  parameters  used  for  the  simulation  of  this 


Figure  15.  The  Quadruped  Walk 


Parameters  Used  for  the  Quadruped  Crawl  Gait  Simulation 
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gait,  while  Figure  16  shows  the  computer  generated  display  of  the 
quadruped  simulation  performing  the  trot.  From  Figure  16,  one  can  see 
that  the  quadruped  has  legs  1  and  4  on  the  ground,  while  legs  2  and  3 
which  are  lefted  off  the  supporting  surface  are  not  displayed.  Also 
it  is  apparent  that  the  trotting  quadruped  resembles  an  inverted 
pendulum  system  as  far  as  its  diagonally  opposite  support  pattern  is 
concerned. 

In  the  trot  gaits  described  by  Muybridge  [  7 ] ,  there  are  phases 
during  which  the  animal  lifts  all  its  four  feet  off  the  ground  in 
between  the  times  when  it  has  diagonally  opposite  legs  on  the  ground. 

But  in  the  computer  simulation,  the  quadruped  is  assumed  to  shift  its 
support  from  one  pair  of  diagonally  opposite  legs  to  another  instanta¬ 
neously.  This  is  indicated  by  the  foot  duty  cycle  which  is  seen  to  be 
0.5  for  all  the  legs  (see  Table  7). 

7.4  The  Inverted  Pendulum  System  Simulation 

The  inverted  pendulum  sy&tem  described  earlier  was  programmed 
into  a  digital  computer  simulation.  A  photograph  of  the  computer  display 
of  this  system  is  shown  in  Figure  17.  Table  10  gives  the  values  of  the 
parameters  used  for  the  inverted  pendulum  including  a  set  of  stabilizing 
control  constants  which  were  obtained  using  the  Routh-Hurwitz  algorithms 
derived  for  this  system  in  Chapter  VI.  The  inverted  pendulum  system  with 
the  pivot  at  the  center  of  gravity  of  the  body,  that  is,  with  r  *  0  is 
easily  stabilized.  However,  the  case  with  r  j1  0  is  harder  to  stabilize. 
Figure  18  shows  the  transient  response  of  the  inverted  pendulum  system 
consisting  of  a  mass  pivoted  at  a  distance  r  below  its  center  of  gravity, 
and  supported  on  &  massless  leg  of  constant  length  i,  A  simple  linear 


Figure  16.  The  Quadruped  Trot. 


Figure  x7.  An  Inverted  Pendulum  System. 
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TABLE  10 

Parameters  Used  for  the  Simulation  of  the 
Inverted  Pendulum  System 
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covt«Ol  constants  ka 

95?“aes  lBaaa.eep 

1MIM*l  St*TE  VECTOR 


2,2100  a.sae*  a.aaaa 


STATE  VECTOR 
X2  <5 


2.11 
2.1 t 
0.20 
Z.30 

a.*? 
2.50 
2 ,6- 
8.72 
2.8? 
0.9? 

I  •  ?** 
1.1? 
‘..2? 
1.4? 
;.«•* 
1.50 
1.60 
1.78 
1.8? 

1.92 
2.  a? 
2.1? 
2.22 

2.32 
2, *2 
2.82 
2.62 
2.7? 
2,82 

2.92 
3.2? 
3,1? 
3,22 

3.32 

J.4? 

3.5? 

3.6? 

3.72 

3.9? 

3.92 
4,0? 
8,12 
t.2? 


-2,*2«i31  f 
8. 822671  -i 
a. 279141  -S 
2. 28969? 
8,277499  -i 
8,86813*  -i 
2,866659  -i 
2. 26729?  - 
a,a659?8-  - 
0.862653  - 
3.859613  * 
a. 2553?!  * 
3.8511*?  - 
2.3*7363  - 

2, 3*277.'  - 
2.23938*  - 
'.’3391?  • 
3.829*75  • 
8,8253**  • 
3,022771  • 
3.31657? 
3,01251* 
0.336631 
3.00*9** 
0,001*73 
-8.001765 
-3,00*757 
-8,037*91 
-0,809561 
-0,012161 
-3<0i  «e9i 
-8.015751 
-0.0171*3 
-0,018275 
-0,01915* 
-3,019799 

-0.020192 

-0,020375 
-0.328383 
-0.0231*? 
-0.019751 
-3.01923* 
-?, 018515 


0,80873*  t 
■2.064018  S 
.0.1**367  S 
..’,163*77  -« 
.0,1**066  *■ 
-0.131013 
-0.128619  I 
-0,!20853  -( 
-0.126881  - 
-0,128382  * 
.0.11301*  * 

-0.186678  * 

.3,099582  - 
-8. 891885  - 
-8,883850  - 
-2.375577 
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0,183397 
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-0.003876 
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27.7BJ522 
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9.9*3266 
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-2.37**21 
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-7.6667*3 
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-S. 57706* 
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-9.78761? 
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-9.7*6792 
-9.55*355 
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5.32 
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5.02 
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6.0? 
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0,2045?* 
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2,2J2l?3 
0,021827 
0,0*1449 
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2,01*778 
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0.004*76 
0.083729 
0.885881 
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8.081628 
8.088976 
8,880369 
-0.003198 
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-0,2227*4 
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•0.02383* 
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-0.000885 
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0.682316 
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0.005765 
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0.006623 
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0,80662? 
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9,083*59 

0,803052 

8,882646 
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-8.5583*6 

-6,188473 

-7,606378 

-7.075922 

-6.5167*7 

-5.936159 

-5.3*1153 

-4.738370 

-4.13*024 

-3.533906 

-2,9433*2 

-2.36719? 

-1.8096*? 

275177 
-0.766683 
-0.267033 
8 . 161865 
0.575793 

6,95556* 
1.299313 
1,686371 
X. 876*63 
2.109681 
2.306*4? 
2.467512 
2.593980 
2.686886 
2.747978 
2.778879 
2.781*39 
2.75765* 
2,709632 

2.6395*7 

2.54063S 

2.4<2j53 

2.319362 

2.183513 

2,83681* 

1.881*16 

1.719397 

1.552757 

1,383387 

1.213080 

1.0*3*99 
8.876188 
8.712557 
?i 553382 
0,401382 
0.255817 
0.118298 
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-0.239955 
-8. 339786 
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-0.508289 
-8.976850 
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feedback  control  lav  Is  used  for  the  stabilisation  of  this  system. 

7.5  The  Quadruped  Pace 

This  is  a  high  speed  gait  thlt  some  animals  employ.  It  is 
faster  than  the  trot.  During  the  pace,  the  animal  uses  two  legs  on  the 
Sjme  side  to  support  itself.  This  gait  has  no  statically  stable  phases 
in  its  locomotion  cycle.  Dynamic  stability  is  achieved  by  alternate 
fall  and  recovery  using  the  two  legs  on  the  same  side.  Muybridge  [7] 
has  shown  that  the  pacing  horse  has  all  its  feet  off  the  ground  for  a 
small  fraction  of  the  locomotion  cycle  in  between  the  times  the  horse 
switches  its  supporting  legs. 

The  pace  is  more  difficult  to  stabilize  than  the  trot.  Since  the 
system  looks  like  an  inverted  pendulum  in  a  direction  perpendicular  to 
the  direction  of  motion,  the  following  correspondence  was  established 
with  the  inverted  pendulum  system  Routh-Hurwitz  analysis. 

Stabilizing  control  constants  were  computed  using  the  dynamic 
parameters  of  the  quadruped  in  the  Routh-Hurwitz  algorithms  for  the 
inverted  pendulun  system.  Then,  one  half  of  the  values  of  the  control 
constants  through  computed  for  the  inverted  pendulum  system  were 
used  in  the  feedback  control  law  for  the  lateral  centering  torque  Ts^, 

a. 

given  by  equation  (6-114) .  Table  11  shows  the  parameters  used  for  the 
simulation  of  the  quadruped  pace.  For  this  particular  gait,  the 
dimensions  of  the  body  were  5*  x  2*  x  2’. 

Figure  19  shows  a  photograph  of  the  quadruped  pace  that  was  dis¬ 
played  by  the  computer  simulation.  For  display  purposes  the  two  legs 
that  are  on  the  ground  have  been  shown  at  the  center  of  the  center  of 
the  body.  Use  of  the  inverted  pendulum  system  Routh-Hurwitz  analysis 


control  constants 


I 

l 

r 

[ 

[ 

E 

E 

E 

E 

E 

E 

E 

E 

E 

E 

E 

E 

l 


134 


Figure  19.  The  Quadruped  Pace. 


Figure  20.  A  Type  of  Biped  Walk. 


for  the  lateral  control  of  the  quadruped  locomotion  system  produced  a 
stable  pace. 

7.6  A  Type  of  Biped  Walk 

There  are  basically  two  types  of  mechanisms  that  bipeds  employ 
for  stabilization  during  walking.  One  of  them  is  body  torquing  for 
lateral  control,  and  the  other  is  foot  placement  for  longitudinal 
control  in  the  direction  of  motion-.  As  an  example,  body  torquing  is 

by  tight  rope  walkers  as  a  stabilization  mechanism.  They  use 
long  poles  to  effectively  increase  their  moment  of  inertia  during  their 
walk  on  the  tight  rope.  Foot  placement  is  important  for  example,  for  a 
stilt  walker  who  maintains  stability  by  alternate  fall  and  recovery  by 
placing  the  stilts  in  the  right  position. 

In  this  research  only  the  body  torquing  mechanism  has  been  inves¬ 
tigated  in  the  simulation  of  a  type  of  biped  walk.  The  idealized  biped 
moves  with  a  constant  velocity  in  the  direction  of  mu, ion  over  a 
horizontal  supporting  surface. 

Table  12  shows  a  complete  set  of  input  data  used  for  the  biped 
walk.  Figure  20  is  a  photograph  of  the  cathode  ray  tube  display  of  the 
biped  gait  simulated  during  the  course  of  this  research.  For  this 
simulation  the  following  assunption  was  made.  Two  parallel  massless 
legs  supporting  the  body  with  the  distance  of  the  body  width  separating 
them  as  in  the  quadruped  pace  display  (see  Figure  19) ,  was  equivalent  to 
support  by  one  leg  with  a  foot  whose  length  was  equal  to  the  width  of 
the  body.  The  result  is  the  display  of  Figure  20  in  which  the 
supporting  leg  is  shown  at  the  center  of  the  body  for  convenience  and 
the  leg  that  is  in  the  air  is  not  shown.  Stabilizing  control  constants 
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for  the  biped  walk  were  once  again  obtained  by  the  application  of  the 
Routh-Hurwitz  algorithm  for  the  inverted  pendulum  system  for  the 
lateral  control  of  this  locomotion  system  using  a  feedback  control  lav 
similar  to  that  described  in  the  previous  section  for  the  quadruped 
pace. 


7.7  Summary 

This  chapter  has  described  the  experimental  results  obtained 
from  digital  computer  simulations  of  the  idealized  locomotion  systems 
considered  in  this  dissertation. 

In  Section  7.2  the  results  of  vibrational  analysis  on  the 
quadruped  locomotion  system  were  given  and  the  validity  of  the  non¬ 
linear  simulation  as  well  as  that  of  the  linearization  techniques  used 

S 

shown  by  the  correspondence  between  their  outputs  to  one  part  in  10  . 
Then  the  actual  parameters  used,  and  the  computer  generated  displays  of 
the  various  quadruped  gaits  such  as  the  crawl,  the  walk  and  the  trot 
were  described.  Section  7.4  outlinec  the  parameters  used  to  obtain  a 
stable  inverted  pendulum  oystem.  The  application  of  inverted  pendulum 
system  stability  criteria  for  the  simulation  of  a  stable  quadruped  pace 
gait  was  covered  in  Section  7.5,  finally,  the  simulation  of  a  type  of 
biped  walk,  using  the  body  torquing  mechanism  for  stability  was  discussed 
in  Section  7,6. 


CHAPTER  VIII 


CONCLUSIONS  AND  FURTHER  TOPICS  FOR  RESEARCH 

8.1  Results  and  Contributions  of  this  Dissertation 

The  following  results  and  contributions  have  been  made  to  the 
study  of  legged  locomotion  systems* 

1)  The  techniques  of  linearization  and  modal  analysis  have  been 
applied  for  the  firet  time  to  the  nonlinear  equations  of 
motion  of  idealized  dynamic  models  of  legged  locomotion 
systems.  From  this,  a  design  tool  has  been  obtained  for  the 
determination  of  stabilizing  control  constants  for  the 
postural  control  of  these  systems.  In  addition,  those  . echni- 
ques  have  provided  a  method  for  determining  the  validity  of 
the  nonlinear  equations  of  motion  describing  the  dynamics  of 
leggec  locemotion  systems. 

2)  The  use  of  the  above  techniques  on  the  nonlinear  equations  of 
motion  of  the  legged  locomotion  system  developed  by  Frank  and 
McGhee  [47]  has  shown  that  some  of  their  assumptions  and 
certain  equations  were  incorrect.  The  appropriate  modifica¬ 
tions  were  made*  and  for  the  first  time  a  completely  authen¬ 
ticated  dynamic  simulation  of  a  massless  leg  quadruped 
locomotion  system  has  bean  obtained. 
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3)  A  nonlinear  simulation  of  an  inverted  pendulum  system  with 
the  mass  pivoted  below  its  center  of  gravity  on  a  mass less 
leg  of  constant  length,  supported  by  a  "  fixed  "  foot  has 
been  developed.  This  simulation  has  been  used  to  show  that 
such  a  system  can  be  stabilized  for  small  motions  about  its 
equilibrium  position  by  torquing  the  mass  using  a  simple 
linear  feedback  control  law. 

4)  Stability  criteria  for  the  controllability  of  both  the 
quadruped  locomotion  system,  and  the  inverted  pendulun  system 
have  been  established. 

3)  Four  dynamically  stable  gaits,  namely,  the  crawl,  the  walk, 
the  trot,  and  the  pace  have  been  simulated  for  the  quadruped 
locomotion  system. 

6)  A  type  of  biped  walk  using  the  body  torquing  mechanism  for 
stability  has  been  simulated.  This  proves  that  the 
techniques  of  inverted  pendulun  stabilization  can  be  applied 
for  the  lateral  stability  of  a  simple  biped  model  consisting 
of  a  mass  supported  on  two  massless  legs. 

8.2  Topics  for  Further  Research 

Some  of  the  areas  where  more  work  is  needed  include: 

1)  Development  of  the  equations  of  motion  of  legged  locomotion 
systems  taking  into  account  leg  mass. 

2)  Stability  and  control  of  the  simulation  of  %  biped  model 
consisting  of  a  body  supported  by  massless  lags  and  using  both 
the  body  torquing  as  well  as  the  foot  placement  mechanisms. 


3) 
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4) 


5) 
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The  system  dynamics  incorporated  in  the  simulations  obtained 
during  the  course  of  this  research  have  assvsed  that  the 
models  had  fixed  stride  lengths  and  gait  periods,  and  were 
travelling  on  level  ground.  This  work  needs  to  be  extender', 
to  simulations  of  leggad  locomotion  systems  producing  stable 
locomotion  over  uneven  terrain  using  variable  stride  lengths 
and  gait  periods. 

The  application  of  pole  assignment  techniques  [70]  to  the 
linearized  equations  of  motion  of  legged  locomotion  systems 
for  obtaining  desired  transient  response. 

Digital  computer  simulations  of  kinematic  models  of  human 
gait  [33]  with  applications  to  the  study  of  pathological 
gaits  [34],  Such  simulations  are  also  useful  as  a  computer 
aided  instructional  tool  for  demonstrating  normal  and 
pathological  gaits  to  medical  personnel. 


8.3  Conclusions 

In  a  real  life  situation,  human  and  animal  locomotion  Is  a  complex 
process  dependent  upon  many  factors  such  as:  1)  visual  inputs,  2)  pro- 
prioreceptive  sensing  of  muscle  dynamics,  3)  angular  acceleration  feedback 
from  the  vestibular  system,  etc.  Simulations  which  include  all  these 
different  aspects  of  system  dynamics  are  difficult,  if  nut  impossible  to 
achieve.  However,  tills  research  ha3  produced  idealized  dynamic  models  of 
legged  loconotion  systems.  These  models  have  simulated  "  marching  "  type 
of  quadruped  and  biped  gaits  using  a  "  model  reference  "  type  of  control 
system.  The  dynamic  thsory  of  lagged  locomotion  systems  needs  extensive 
further  development. 


The  next  step  is  to  extend  the  work  to  the  simulation  of  loco¬ 
motion  systems  which  take  into  such  factors  as  leg  mass,  the  nature  or 
the  terrain,  variable  foot  placement,  etc.  Such  systems  would  probably 
need  adaptive  controllers  as  well  as  inertial  guidance  systems  for  their 
stability  because  the  locomotion  system  would  have  to  change  its  gait 
automatically  to  take  care  of  variations  in  the  terrain. 

If  leg  mass  is  included,  the  equations  of  motion  of  a  legged 
locomotion  system  become  quite  complicated.  For  example,  if  a  biped 
is  modeled  as  a  rigid  body  with  two  arms,  and  two  legs,  with  each  limb 
having  a  two  degree  of  freedom  hip  (shoulder)  joint,  and  a  single  degree 
of  freedom  knee  (elbow)  joint,  then  this  model  has  eighteen  degrees  of 
freedom,  and  is  therefore  described  by  a  36th  order  differential  equation. 

The  type  of  biped  gait  simulated  in  this  research  has  used  only 
the  body  torquing  mechanism  for  its  stability.  A  more  comprehensive 
treatment  of  biped  dynamics  should  include  both  the  body  torquing  and  the 
foot  placement  (base  motion)  mechanisms  for  stability  in  the  lateral 
as  well  as  the  longitudinal  directions  respectively. 

Even  though  legged  locomotion  systems  are  inherently  very  complex, 
this  research  has  shewn  that  it  is  possible  to  construct  a  mathematical 
basis  for  their  system  dynamics  by  the  application  cf  the  laws  of 
mechanics v  modern  control  theory,  and  computer  simulation. 
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COMPUTER  PROGRAMS  WITH  EXPLANATION 

A.l  Introduction 

This  appendix  lists  the  computer  programs  used  in  the  course  of 
this  research  along  with  an  explanation  covering  both  the  various 
symbols  used  as  well  as  a  description  of  che  program.  Section  A. 2  dis¬ 
cusses  the  main  program  for  the  quadruped  gaits.  Thio  program  is  used 
to  simulate  the  quadruped  crawl,  the  walk,  and  the  trot  gaits.  Section 
A, 3  discusses  the  modification  of  the  main  quadruped  program  for  use  in 
the  vibrational  analysis  of  the  quadruped  locomotion  system. 

Section  A.4  covers  the  computer  programs  used  for  obtaining  the 
linear  system  response  of  the  quadruped  locomotion  system.  This  section 
lists  the  main  program  for  obtaining  Che  eigenvalues  and  eigenvectors  of 
the  real  non-syiametric  modal  matrices  of  the  linearized  quadruped  locomo¬ 
tion  system,  as  well  as  the  subroutine  LINEAR  used  to  compute  its  linear 
system  response. 

Section  A.5  describes  the  program  used  for  the  simulation  of  the 
inverted  pendulum  system  considered  in  the  dissertation.  It  also  inclu¬ 
des  a  listing  of  the  algorithm  used  for  computing  the  stabilizing  control 
constants  using  the  Routh-Hurvitz  analysis. 

Finally,  Section  A. 6  describes  the  modifications  made  to  the  main 
walking  program  of  Secitoa  A. 2  to  simulate  the  quadruped  pace  as  well  as 
a  type  of  biped  walk. 
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A. 2  Computer  Program  of  the  Quadruped  Locomotion  System 

This  program  is  used  to  simulate  the  following  quadruped  gaits: 

1)  the  crawl,  2)  the  walk,  and  3)  the  trot*  The  main  program  listed  in 
Figure  21  should  be  used  with  the  Macro  subroutine  PIC  given  by  Figure 
22  for  use  on  the  PDP-9  computer  of  the  Digital  Equipment  Corporation. 

For  use  with  any  other  digital  computer,  the  main  program  should 
be  used  with  the  proper  display  subroutine  after  making  the  appropriate 
changes  in  subroutine  PICTUR  to  modify  it  to  .suit  the  particular  display 
package  used.  This  program  uses  the.  Euler  Predictor-Corrector  method  of 
integration. 

The  following  is  a  partial  listing  of  the  symbols  used  in  this 
program: 

A(4)  *  o  the  actual  forward  angle  of  the  leg  at  the  hip 
AC(4)  «  »c  the  desired  forward  angle  of  the  leg  at  the  hip 
B(4)  *  B  the  actual  lateral  angle  subtended  at  the  hip  by  the  leg 

BETA (4)  -  the  foot  duty  cycle,  percentage  of  the  cycle  the  foot  is  on 
the  ground 

CPH  «  cosine  4 

CT  =  fraction  of  tbs  present  period  which  has  elapsed 
CTH  “  cosine  8 

DA(4)  *  derivative  of  angle  a 
DAC(4)  -  time  derivative  of  the  desired  angle  a 

c 

D3(4)  *  derivative  of  angle.  0 
DL(4)  ®  time  derivative  of  the  leg  length  t 
DLC(4)  =  time  derivative  of  the  desired  leg  length  lQ 
DOTX  =>  stride/period  ■  desired  x-directed  velocity 
DT  *  differential  tiue  increment  for  integration 
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DTP  -  time  between  printouts 

DX(12)  *  time  derivative  of  the  state  vector  x 

F(3)  =*  force  vector  Jf  applied  to  the  bo^y 

FZP(4)  *  force  in  the  z  direction  due  to  each  leg 

G(4)  »  PHI(4)  +  BETA(4)  -  1.0  »  Instant  when  foot  is  lifted  in 

a  cycle.  If  G  is  greater  than  zero,  foot  is  lifted  in  next 
cycle.  If  G  is  less  than  zero,  then  the  foot  is  lifted  in 
this  cycle. 

GAMMA(4)  *  position  of  the  foot  when  it  first  touches  the  ground  rela¬ 
tive  to  the  body  in  stride  normalized  coordinates 

H(3,4)  -  matrix  of  hip  positions 

I,J  ■  general  indexing  variables 

M(4)  «  indicator  of  the  foot  position:  M  «  1  (on  ground)  ,  M  -  0 
(off  ground) 

PER  »  period  of  the  walking  cycle 

PHI (4)  «  phase  of  the  foot  action  relative  to  the  first  foot  action 
STH  »  sin  0 

STD  «  length  of  the  stride 

T(3)  =  torque  vector  T_  applied  to  the  body 

TIMF,  ®  total  elapsed  time  of  the  gait 

TM(4)  ■  motor  torque  applied  at  the  hip  (T  ) 

mi 

TMAX  “  raaximun  time  of  the  gait 

TP  «  next  scheduled  printing  time 

TS(4)  “  lateral  torque  T_  at  the  hip 

8i 

Tl(3,3)  *  the  matrix  of  transformation  T^ 

T2(3,3)  «  the  matrix  of  transformation  T2 

T 

T3T(3,3)  =»  the  transposed  matrix  of  transformation  Tg 
X(l?.)  *  the  body  state  vector  x 

*  the  next  position  of  the  foot  in  ground  coordinates 


XF(4) 
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T 

XI (3)  *  moment  of  inertia  vector  ■  [I  ,  I  »  I  ] 

xx*  yy*  z?.1 

XK(10)  *  control  constants  through  K^q 
XL(4)  -  leg  lengths  * 

XLC(4)  »  magnitude  of  the  leg  length  projected  on  the  x-z  plane 
XMASS  *  mass  of  the  body 

XS(12)  «  previous  value  of  the  state  vector  x  saved  for  the 

computation  of  at  using  the  Euler  Predictor-Corrector  raethc- 
of  integration 

YF(4)  «  y  coordinate  of  the  foot 
ZR  «■  z  coordinate  of  the  body 
The  following  symbols  are  used  in  subroutine  FANBM: 

CA  ■  cosine  a 
CB  «  cosine  B 

?FX,FPY,FPZ  «  forces  applied  to  the  body  by  leg  i  at  the  hip 
FX,FY,FZ  *  total  leg  force  In  body  coordinates 
SA  «  sine  a 
SB  «  sine  B 

TX,TY,TZ  *  torque  applied  to  the  body  by  the  legs 
XM,YM,ZM  *  moments  due  to  forces  applied  at  the  hip  sockets 

The  following  symbols  are  used  with  subroutine  MODEL: 

CG  *  fraction  of  the  present  stride  which  has  been  executed 
CT  *  fraction  of  present  cycle  which  has  elapsed 
NT  *  number  of  elapsed  periods  of  gait  cycle 
XDNF(4)  »  next  position  of  the  feat  in  body  coordinate  system 

XNF(4)  «  next  position  of  the  feet  in  normalized  body  coordinates 

The  following  symbols  are  used  with  subroutine  LEG: 


CPS  “  cosine  ^ 


C  FORTRAN. 

C  THIS  PROGRAM  IS  FOR  THE  SIMULATION  OF  THE  QUAORUPEO  LOCOMOTION 

C  SYSTEM  GAfTS.  THIS  PROGRAM  SHOULD  BE  USED  WITH  THE  MACRO  SUB* 

C  ROUTINE  PIC  FOR  DISPLAY  PURPOSES ,  THE  QUAORUPEO  GAITS  SIMULATED 
C  BY  THIS  PROGRAM  AREt  THE  CRAWL*  THE  WALK  AND  THE  TROT. 

C  THIS  PROGRAM  CAN  BE  USED  WITH  THE  PROPER  OISPLAY  SUBROUTINES 

C  ON  ANY  OIGITAL  COMPUTER. 

C 

C  PSEUDO -DIMENSIONED  VARIABLES  (E.6.1  X>(3)  »  Xl#  X2.  ♦  x3> 

C  1BETA(4),  0(3)*  0XL(3).  F(3).  T<3>.  TU3.3),  T2(3,3) 

C  2T3T(3*3) *  XB(3) *  XI(3)t  XT(3) 

LOGICAL  LOOP*  MU),  HEADNG*  WOF 

DIMENSION  A(4) *  AC(4),  1(4).  0A<4).  0AC(4) ,  0f<4),  DL(4>, 
10LCU),  OX j 12) *  FX(4 FY(4),  Fl(4),  FiP<4),  6(4),  GAMMA (4), 

2Hl ( 4 ) *  H2C4).  H3(4)«  PHI (4) *  TH<4)»  TS(4),  TX(4), 

STY  <  4 )  *  TZ(  4)  *  X(12)»  Xf(  4)  *  XM10),  XL(4),  XLCI4), 

4XM(4 > ,  XS(12),  YF(4).  YM(4).  IM{4>»  CENPUT(S0),  E*£CUT(6B). 
5TITLE(4),  IHX(4) *  IHY(B).  lFX<4),  IFY<4) 

COMMON  DXi,  0X2*  DX3*  0X4,  0X9*  OXB*  0X7,  OXB,  QX«,  0X1», 
lDXU,  0X12,  FX1,  FX2,  FX3.  PX4,  FY1,  FY2,  FYJ.  FY4,  Fll, 

2F22 ,  FIS,  FI4,  61,  62.  6$,  64.  TXl*  TX2*  TX|,  TX4,  TY1* 

3TY2*  TYS,  TY4,  Til,  12.  T23,  T14.  XN1,  XN2* 

4XM3,  XM4,  YM1,  VMJ,  YM3,  YM4,  SMI,  ZM2*  2H3,  1M4 
COMMON  /INPUT/  BETA1,  BETA2*  BETAS*  BETA4*  GAMMA, 

1PM If, •  PHI2.  PHil,  PHI4,  HI*  H2.  H3*  YF.  STO.  PER.  1R,  OT. 

2TNAX,  XI.  X2,  XI,  X4»  X9,  X*.  X7,  Xi»  X9,  Xlf, 

3X11.  X12,  XMAS*  XU,  XI2*  XI3.  XKl*  XK2,  XX3 *  XK4,  XK9* 

4XK4,  XN7,  XKB*  IIK9 *  DTP*  070,  Till*  Tll2»  TU3,  T121.  U22, 
9T123,  T131,  T132*  Tl33*  C6*  XF,  M.  UOR*  WOF, 

6TIYLE1,  TITLE2 ,  TITLE? *TITLE4.XKi» 

COMhOn  /OISP/  IMX1,  IHX2.  IHX3*  IHX4.  IHY1.  IHV2,  IHY3* 

1IHY4 , IHY9* IHYft* IHY7* IHY8 
EQUIVALENCE  (IHX(l).lHXl),  (IHY(I).IHYI) 

EQUIVALENCE  (OX<i),OXl).  (FX(l),FXi). 
i(FY(l),FYl),  (Fill ),F]1) ,  (6(1), Gl). 

2(PHtU)*pMU)»  (TX(l)eTXl),  (TY(l)oTYU* 

3(T£(1>  «T£l) ,  (X(1),X1),  (XK(l)fXKl).  (XM(l).XHl),  (YM(l).YMl), 
4(5M(1)0«M1>,  ( EXECUT ( 1 ) * BETAl ) ,  (TjTLEd), TITLED 
DATA  HEAONG/. FALSE. /.BLANKS/9H  /.XONE/l.B/ 

C 

C  •••  first  half  CF  MAIN  PROGRAM  ••• 

C 

I  ADR  «  IAOOR(TITLEd)  > 

IBS  IF  (HEAONC)  GO  TO  11B 
HEADNG  •  .TRUE. 

US  WRITEU.6B0) 

CALL  ACCEPT  (4*  X) 

IF  (K)  17'J, 240,120 
12B  00  150  L  ■  1*  K 

CALL  ACCEPT  (4.  I.  DEN) 

IF  (1)  150,  15B,  130 
13P  IF  (I  -  61)  140,  160,  150 
140  EENPUT  (I)  «  OEN 
150  CONTINUE 
CO  TO  US 

160  READ  (4,580  TITLE 
GO  TO  110 


Figure  21.  The  Main  Quadruped  Nonlinear  Gait  Program 
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170  IF  (K  ♦  2)  230 »  20fl.  180 
180  00  190  !  •  1.  87,  4 

CALL  ACCEPT  (9#  BETA1,  BETA2,  BETAS.  8ETA4) 
EENPUT(l)  •  BETA1 
EENpUT  < I ♦! )  «  BETA2 
EENPUT ( I *2)  »  Bf TA3 
190  EENPUT! 1*3)  »  8tu4 
tItlei  •  Blanks 
TITLE2  •  BLANKS 
TITLES  «  BLANKS 
TJTLE4  «  BLANKS 
CO  TO  110 

200  00  210  I  «  1.  80 

210  EXECoTU)  «  EENPuT(l) 

00  220  1  >  1.  3 
DO  220  L  •  1,  4 
J«4«l»L*i 
K  ■  3  •  L  ♦  I  ♦  9 
320  EXECUT(J)  s  E£NPUT(K) 

WRITE  (8.970)  TITLE.  EXECUT 
CO  TO  110 

230  WRITE  (7,590}  (SENPUT(I).  I  *  1*  60) 

CO  TO  110 

240  WR jTE  (4,- 610) 

CALL  ACCEPT! 4.XK10) 

00  250  I  •  1,  60 
250  EXECUT ( I )  •  EENPUT (I ) 

90  260  I  •  1.  3 
CO  26W  L  •  1.  4 
J  »  4  •  I  ♦  L  ♦  8 
K*3*L*I*9 
260  EXECUT (J)  «  EENPUT (K) 

WRITE! 6, 570)  TITLE.  EXECUT.  BLANKS,  TITLE 
IF  (OTO)  270,290.200 
270  WOF  •  .FALSE. 

OTO  •  -OTO 

CO  TO  290 

280  WOF  ■  .TRUE. 

290  CONTINUE 

Cl  «  PHll  ♦  0ETA1  -  i, 

C2  •  PHI2  ♦  8ETA2  -  l, 

C3  •  PH13  ♦  0ETA3  -  l, 

C4  •  PHI 4  ♦  8ETA4  -  1. 

TP  •  -0.00001 
TO  •  -0.00001 
TIHE  •  0. 

OOTx  «  STO  /  PER 
LOOP  «  .TRUE, 

C 

C  SUBROUTINE  ’MODEL’  ••• 

C 

300  NT  »  INT(TIME  t  PER) 

FNT  «  FLOAT  (NT) 

CT  «  (TIME  -  FNT  •  PER)  /  PER 
CC  ■  (FNT  ♦  CT)  •  STD 
00  390  I  »  1.4 
IF  (C( I) )  310,  310,320 


Figure  21 


Continued 
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310  IF  (Ct  -  PHi(l>>  338*  340.  348 
320  JF  <CT  -  Pul  (ID  300,  350*  350 
330  H(I>  *  .FALSE. 

XNF  >  CAHHA(I)  •  sro 
CO  TO  360 

340  IF  (CT  «  C(J)  -  1.0)  350.  350.  330 
350  M(  l )  «  .TRUE. 

XNF  «  (CAHMA(I)  ♦  PH1<1>  -  CT)  •  STD 
CO  TO  380 

360  IF  (CT  -  C<!>)  370,  370,  330 
370  H( I )  *  .TRUE. 

XNF  «  (CAHMA(I)  ♦  ?H | ( 1 )  -  CT  -  1.0>  •  STO 
380  XF  ( 2 )  «  XNF  *  CC 

OEN  a  XNF  -  Hl(t) 

Ac( 1 5  ■  ATAN(OEN/gR) 

XLC<!>  •  SQRT(0£N*0EN  ♦  2«»2R> 

OAC(I)  •  -OOTX  *  2R  /  (XLC ( 1 >«XLC( 1> > 

390  OUC< I>  ■  -OOTX  *  OEN  /  XLC(I) 

C 

c  •••  subroutine  'leg*  •»• 
c 

CTH  a  C0S(X7) 

STH  a  S)N(X7) 

CRH  a  COS( X8) 

SPH  a  S{N(X8) 

CPS  a  COSi X9) 

SPS  a  S I N  ( i*  9 ) 

Till  «  CTH  •  CPS 

T112  a  CTH  •  SPS 

T113  a  -STh 

T121  a  CPS  a  STH  •  SPH  -  SPS  a  CPH 

T122  a  CPS  a  cPH  ♦  SPS  •  SPH  a  $TH 

T123  a  CTH  a  SPH 

T131  •  SPS  a  SPH  ♦  STH  a  CPS  •  CPH 

T132  =  SPS  a  STH  a  CPH  *  CPS  •  SPH 

T133  a  CPH  a  CTH 

T211  a  0.0 

T212  a  CPH 

T213  a  -SPH 

T221  «  1,0 

T222  a  STH  a  SPH  .<  CTH 
T223  a  STH  a  CPH  /  CTH 
T231  a  0.0 
T232  ■  SPH  /  CTH 
T233  a  CPH  /  CTH 

0X7  a  T2H  •  X10  ♦  T212  •  *11  ♦  T213  •  X12 

0X8  a  T221  •  X10  ♦  T222  a  XU  ♦  T223  •  Xl2 

0X9  a  T231  a  X10  ♦  T232  *  XU  ♦  T233  •  X12 

DO  400  l  a  i,  4 

XT 1  a  XF(I>  -  XI 

XT2  a  YF( I )  -  X2 

XT3  »  -X3 

X81  a  KTi  a  Till  ♦  XT2  a  TU2  ♦  XT3  •  TU3 

X02  a  XTl  a  T121  ♦  X72  a  T122  ♦  XT3  a  T123 

XB3  a  XTl  a  Tl3l  ♦  XT2  •  T132  ♦  XT3  *  Tl33 

01  •  X01  -  HKD 
02  «  XB2  -  H2(D 


Figure  21.  Continued 
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D3  «  XB3  -  H3(  I ) 

XU!)  «  SORT (01*01  *02*02  ♦  03*03) 

Ail)  a  ATAN (01/03) 

OEN  •  02/XL ( I ) 

OEN  «  0£N/SQRT(1 ,  -  DEN*DEN) 

8(1)  «  -ATaN(DEN) 

lSJn  !  i?^J^P?'*^9#Tll2>#XTl  *  «0»»*m-0X7»STM*SPS> 

«  <0X7*T111.SPH*DX8*T131-0X9*U22).XT1  *  (0X7* 

2XT32-SX5*0X8#Tl32*DX9#T121>#XT2  ‘  <0x7#STH*SPH-DX8*U33>* 

OXU3  «  <0X7*Tlll*CPH-0X8*Ti2i-DX9*Tl32)*XTl  ♦  (DX7*Tii?*ppm 
i'X6*Ti22*0X9*Tl3l).XT2  -  (0X7 *S TH«C?S*0 J T J1- It 

let..  sJSfi  0<‘-2  * 02  * o,,u  •  m>'  xi"> 

OA(I)  *  (OXLl  *  03  •  DXj.3  •  01)  /  DEN 

08(!)  «  (OKI)  •  02  -  XI. Cl)  .  0XL2)  /  (XU!)  •  SQRT(OEN)) 

•••  SUBROUTINE  ’CONTrU  ••• 

00  420  I  «  l,  4 
IE  <M(D)  SO  To  410 
TH<I)  »  0, 

TS ( I )  a  0, 

EZP<J>  a  0. 

GO  TO  420 

Tm(I)  a  Xk1*(A(I )-AC(I >)  ♦  XK2*(0A(I)-0AC( l) )  ♦  XK7#X4 
T.(I)  a  XK3*B( I)  ♦  Xk<*DB( I)  ♦  Xk8*X2  ♦  XK9*X5 

CONTINUE  XK5#<XL<I,-XLC(I>>  ♦  XK6*(DL( ! )-OLC( I ) )  -  XKJ0 


•••  SUBROUTINE  ‘FANON»  **• 


00  430  I  a  1,  4 
CA  a  COS ( A ( 1 ) ) 

SA  a  S!N( A( I ) ) 

CB  a  COS (B( 1 ) ) 

Si  a  S]N( B( I ) ) 

TX( I >  a  TS ( I )  •  CA 
TY ( I )  a  TM( I ) 

T2U)  a  -TSU)  •  SA 
T3TU  a  CA 
T3712  a  SA  a  SB 
T3T13  a  CB  •  SA 
T3T21  «  0. 

T3T22  a  CB 
T3T23  «  -SB 
T3T31  «  -SA 
T3T32  ■  SB  *  C* 

T3T33  «  CB  *  CA 

FPX  «  TH(I )  /  (XU  I)  •  CB) 

FPY  a  -TSU)  /  XUI> 

FPZ  a  F2P(I) 

FX(!>  a  T3?ll  »  FPX  ♦  T3T12  •  FPy  ♦  T3T13  •  FP2 

FYU)  «  T3T21  •  FPX  ♦  T3T22  *  FPy  ♦  T3T23  •  FP2 

FZ(I)  a  T3T31  *  FPx  ♦  T3T32  •  FPy  *  T3T33  *  FP2 

XKU)  •  H2(!)  •  F2(I)  -  H3( !  )  •  FY(  1  > 


Figure  21.  Continued 
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YKt  I  >  *  H3<U  *  FX  ( 1  >  -  Hit!)  •  F2U) 

2HC)  »  H1<1)  •  FY(I)  -  H2U)  •  FXU) 

Fi  «  FX1  ♦  FX2  *  FXJ  ♦  FX4 
F2  «  m  ♦  F y2  ♦  FY3  ♦  FY4 
F3  *  F21  ♦  F22  ♦  F23  *  F24 

Tl  *  TXl  ♦  TX2  ♦  TX3  ♦  TX4  ♦  XH1  ♦  X«2  ♦  XM3  ♦  X*4 
12  «  TYt  ♦  TY2  ♦  TY3  ♦  TY4  ♦  YH1  ♦  YH2  *  YM3  ♦  YH4 
T3  ■  T21  ♦  T22  ♦  T23  ♦  T2<  ♦  2K1  ♦  2M2  *  *H3  ♦  2M4 


*«•  SUBROUTINE  'X00T'  •*• 


0X4  •  X5  •  X12  -  X6  *  XU  ♦  FI  /  XHAS  -  32.2  •  STH 

0X5  «  X6  »  <10  -  X4  •  Xl 2  ♦  F2  /  XHAS  ♦  32,2  •  CTM  *  $PH 

0X0  *  X4  •  Xli  -  X5  «  X10  ♦  F3  /  XHAS  ♦  32.2  •  CTH  *  CPH 

0X10  s  ( (X !2  -  X 1 3 )  •  XU  •  X12  ♦  Tl)  /  X!1 

0X11  «  ( (X 13  -  XU)  *  X10  •  X12  ♦  T2)  /  XI2 

0X12  «  C <X li  -  X 1 2 )  *  Xl0  •  Xjl  ♦  T3>  /  XI3 

0X1  #  Tlli  *  X4  ♦  T121  «  X5  ♦  T131  •  X6 

0X2  «  "112  •  X4  ♦  7122  •  X5  ♦  7132  •  X6 

0X3  «  Tli3  «  X4  ♦  7123  *  X5  ♦  7133  *  X6 

SEC0N0  HALF  OF  MAIN  PROGRAM 

IF  {LOOP)  GO  70  520 
LOOP  »  , YRUE , 

00  440  i  s  Is  12 

XU)  *  (XS*I>  ♦  OXU)  •  07  •  XC Z >  >  /  2, 

IF  (TIME  -  YD>  490,  450,  450 
70  »  70  ♦  070 


SUBROUTINE  ’PIcYUR* 

XHOG  s  XI  *  CG 
00  460  I  ■  1#  4 

XX  »  7111  •  Hid)  ♦  T12J  •  H2(  l)  ♦  T131  •  H3d>  *  XHCG 

VY  *  7112  •  H1U)  ♦  7122  •  H2U)  ♦  7l32  •  H5<!)  ♦  X2 

22  ■  7113  *  HUD  ♦  7123  •  H2(!>  ♦  7133  •  H3U)  «■  X3 

IHXU>  *  I  NT  (40,0  •  XX  -  32.0  *  VY>  ♦  265 

IHYCD  ■  INTC-12,0  •  YY  -  40,0  •  22)  ♦  90 
1HY( !♦♦)  «  IMY( l )  ♦  INT(00,0  •  HS(I>) 

IF  (,NQ7,  H(D>  CO  70  460 
YEF  •  X2  YFU) 

IFXII)  «  fNTUXFCl)  -  XI)  •  <8.0  ♦  YEF  •  32.0)  ♦  265 
IFYU)  «  I  NT ;  fCF  »  12,0)  ♦  90 
CO NT INUE 
CALI  ERASE 

CALL  POINT  {0,  400,  0} 

CALL  LINE  ($8f,  400) 

CALL  POINT  <0,  222,  0) 

CALL  LINE  {64,  222) 

CALL  LINE  (0,  196) 

CALL  LINE  (64,  196) 

CALL  POINT  {447,  222,  0) 

CALL  LINE  (511,  222) 

CALL  LINE  (447.  198) 

CALL  L INC  i5U»  198) 

CALL  POINT  (265,  200,  0) 


Figure  21,  Continued 
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iccx  *  int(xmcg  •  4s,0  -  x:i  •  32.0)  ♦  265 
ICG?  »  IH'I  (-X2  •  12,6  -  X3  •  46,0)  ♦  90 
CALL  pOINT<  ICCX,  ICCY » J. > 

CALL  POINT  UHX1,  lHYl.li) 

call  line  uhxs.  i hyz) 

call  LINE  UHX4.  IHY4) 

CALL  LINE  <!HX3,  IHY3) 

CALL  LINE  (IHX1,  IHYl) 

CALL  LINE  (IHX1.1MY5) 

CALL  LINE  { lHXg, 1HY6) 

CALL  LINE  <iKX2,lHY2> 

CALL  PC!NT(IHX2<2HY6,6) 

CALL  LINE  (IHXA.JHY8) 

CALL  LINE  <1HX4.IHY4) 

CALL  PO{NT( IHX4,!HYd,0> 

CALL  LINE  (IHX3.INY7) 

CALL  LINE  ( !HX3« 1HY3) 

CALL  POINT { IHXJ, JHY7.0) 

CALL  LINE  UHX1.1HY5) 

00  47*  I  «  1,  4 
IF  (.NOT,  M ( l ) >  SO  TO  47# 

CALL  POINT  (IHX(l),  IHYU),  «> 

CALL  LINE  UFXU),  IFYU)> 

470  CONT INUE 

CALL  POINT  (l$$,  25,  0} 

CALL  SYNbOL  (UOR,  4) 

CALL  POINT  (0.  400,  0) 

IF  OOF)  GO  TO  490 
C 

C  •••  TRIGGER  ANIMATION  CAMERA 
C 

CALL  ON 

DO  480  1  «  1,  50 
480  XX  »  XONE  •*  2 
CALL  OFF 
498  CONT 1NUE 
C 

C  ••*  REMAINING  PORTION  OF  SECOND  HALF  OF  MAIN  PROGRAM  •  •• 
C 

V  (TIME  -  TP)  sit,  $80,  $00 
500  TP  «  TP  *  OTP 

WRIT*  (6,500)  TIME,  ?1,  F2»  F3,  tl,  T2,  T3 
WRITE  (6,590)  X,  TM,  TS,  F2P,  A.  B,  XL 
510  IF  (TIME  -  TMAX)  300,  300,  100 
520  LOOP  «  .FALSE, 

00  530  I  *  1,  12 
XSU)  c  XU) 

530  XU)  b  XSU)  ♦  OXU)  •  OT 
TIME  »  TIME  ♦  OT 
GO  TO  300 
540  REAO  (5,580) 

STOP 

C 

C  »*  FORMATS  *•« 

C 

3*9  FORMAT  ( 4( IX «  Gl8,4>) 

560  FORMAT  U*15(F9,3.  IX)) 


Figure  21.  Continued 
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ll8X*22HV*LUE  FOR  FOOT  NUH8£R-»42X*X6HINP0T  PARAMETERS 
i//6X»iHX#X4X»XH2*X4X»lH3»X4X»iH4»i3X*4MNANE*4X*ilH0E SCRIPT ION/ / 
21X»4(Fi2.5»3X>*3X»4HB£TAf5X»l5HF00T  OUT*  CYCLE/ /XX*4CFi2*>*3X>»5X* 
35HCAMMA * 4X « 3f HX "COORO •  OF  FOOT  AT  Y8UGH«’O0HN//XX»4IFX2»5*3X)*3X» 
43HPMJ #  6X » 44HPHASL  OF  FOOT  ACTION  -  «ME»  FOOT  IS  SET  SOWN// 
51X»4{Fi2,5»3X).3X.6HMa<-ItSX,i?HX-C00R0.  OF  Mi? 

*1X  .<  i  F12 ,3 ,3X>  »3X#fHMi  2*  ->  1 JX,  32HT  -COORD  OFHIPJ  ,  H  BOOT  COORD » 
7/89X.lH>/XX,4tFi2.$,3X>»3X*6HH<3*~>*3X»t7H2-C0OR0,  Of  HJP  Mt 

8iXc4lF42,5#SX>*xXt2HYF»TXi5iHT*000R0,  Of  FOOT  IN  BOOT  CSORO«// 
9XX*9M$TRID£  &  »F5S2}4K  FT,»5X,9HPEHl00  *  *F5.2*9H  8£C.»§X» 
12THDESIRED  2-COORO,  Pf  BOOT  *  SF5.2»4H  FT, //XX* 

Stx1li«i!rU!»'iK’rT.jx,8K»;.ri*.*.SH 

4F12,4*3H  rT.£X#2HX*tFl2*8,3HF/S(iX«2HY»»Fi2.*.3Kf/S» 

SIS  ,2H2  sc F12*  6*  3MF/S/5§X»  XH»e  21 17X» ...... 

6XX#2H0*»FX2.4»4K  RA0*iX*2K0**Fi2.6*4H  ^C*.*****^**  _ 

7PX2.6.4H  RA08iX»2He*»Fi2.A»5M*/S*ix*2>J0»tFX*.|»JH*/S» 

9///47X f 24HB0DY ^ I NERT I AL  PROPERTIES// 

2iX,7MM.'SS  •  ,F7,2.iiX.31HH0HEMTS  OF  IHERTIi--  X-AXIS  *  , 
lF7.2.1«Xc9HY-AXlS  •  »F7,2#E#X* 9M1»AXIS  * 

25iX*  17MC0NTR0L  CONST ANTt//6X»iHX#i3X»iH2»iiX»XH3»i2X»XH4* 

*12X  *  XH5* X2X » XH6»  X2X » lH7c 12Xs  SH  8»  K2*»  2H8PPI W  'ri^ 

430X* XAHOUTPUT  CS«STANTS//iXf.l7MPRINT  INTERVAL  •  *F7.3. 

3SN  SEC..11X.19M0ISPLAT  INTERVAL  *  £7»3.36H 

61  f  ,LT*  BoO*  M/  AUTC.  PHOTO* )/XHJ »A5*43X*4A3//48X»3aNPRINTE0 
70UT?UT  F0RMAT//8X.6H(TIMEI,6X»22H<FK<CES  ON  BOOT  X-T-2)»SX* 
•23H(T0R0U£S  ON  SOOT  X-Y-i)/26*»3l9X»XH, i43BX*3<9X9XK,)/ 

92<3X,lHX,9X.lKY.9X#lH2.4X>.2<3XiaH0»9X9iN0(.9X*lNy*<X)/ 

3 1H* » 64  X  *  XH- . 3 <9X , 1H I >  #  9X  »  XH- *  9' « » XH l, //7X » 26H < HIP  HO  .OR 

1  TOROUE  1-2-3-4)jX4X*27H(HIP  SPRING  TOROUE  1-2-3-9) ,X2X*  _ 

228H(vERTICAL  LEG  FORCE  X-2-3-4)//7X#27HlFQRNAR0  MIP  ANGLE  X-2-3-4) 
3,13X;27H(LATERAL  HIP  ANGLE  i*2-3-4>.X4X,28HtLEC  LENGTH  l-2-3-4>//> 
FORMAT  (4A5) 

FORMAT 1/12IF8* 4* 150  ) 

FORMAT {X9H  READY  FOR  INPUT  N*> 

FORMAT J16H  TTY  INPUT  XK10#> 

END 


Figure  21.  Continued 
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/  MACRO* 

/  SUBROUTINE  PIC  -  ROUTINE  TO  ESTABLISH  THE  PROPER  LEyEL  OP 
/  INDIRECT  ADDRESS  INC  FOR  CALLING  THE  SUBROUTINE  SYMBOL  AND 
/  FOR  TRICGEREINC  THE  ANIMATION  CAMERA  YlA  YM£  A/D  CLOCK  F/F, 
/ 


.CLOBL 

IA00R 

.CLGBL 

ON*1 

A5CL0N37B1624 

A9CLOF.701644 

JAOOR  • 

LAC 

IADOR 

TAD 

<1 

oac 

X 

LAC* 

X 

JMP» 

I  ADDS 

X  • 

ON  6 

ADCLON 
JMP»  ON 
OFr  » 

AOCLOF  , 
JMP»  OFF 
eENO 


Figure  22.  Subroutine  PIC  -  Macro  Language  Subroutine 
for  Interphasing  the  CRT  Display  System  to 
the  PDP-9  Computer. 


s  w  *r+*~*o*r*ss-#£r  zx&t+ssx? 
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D(3)  *  position  of  a  leg  in  body  coordinates 
BEN  -  intermediate  computational  variable 
DXL(3)  ■  derivative  of  foot  position  in  body  coordinates 
SPS  *  sine  f 

XB(3)  *  position  of  a  leg  in  body  coordinates 
XT (3)  *  position  of  a  foot  in  ground  coordinates 
The  input  to  the  quadruped  gait  program  is  by  means  of  paper  tape 
and  consists  of  the  values  of  70  parameters  which  upeei fy  the  body  dimen¬ 
sions,  control  constants,  kinematic  parameters  cf  the  particular  gait, 
etc.  Each  gait  has  a  separate  paper  tape,  and  ir«  addition  any  parameter 
value  can  be  changed  if  desired,  and  a  tsew  paper  tape  punched  out-. 

Values  of  the  various  quantities  cdo  be  printed  on  a  line  printer 
if  desired,  and  a  visual  display  of  the  locomotion  system  is  produced  on 
a  cathode  ray  tube  display  system  attached  to  the  computer. 

This  quadruped  gait  program  was  also  put  on  the  faster  PDP-10 
computer  using  a  different  display  package  (subroutine  DISPL),  The 
faster  computational  time  of  this  computer  and  its  better  display  system 
produced  displays  of  the  quadruped  gaits  that  approached  simulation  in 
real  time. 

A. 3  Vibrational  Analysis  of  the  Quadruped  Locomotion  System 

The  computer  program  described  in  Section  A. 2  is  the  main  non¬ 
linear  quadruped  simulation  for  producing  quadruped  gaits.  This  program 
needs  to  be  modified  to  produce  a  postural  quadruped  locomotion  system. 
For  vibrational  analysis,  the  quadruped  is  assused  to  stand  on  all  its 
four  feet  with  its  hips  vertically  above  each  leg.  Therefore,  the  only 
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changes  that  are  needed,  are  in  the  subroutine  MODEL.  That  is,  the 
reference  model  needs  to  be  changed  from  one  describing  "  marching  "  type 
of  motion  to  a  51  postural  "  type. 

Accordingly,  subroutine  iiDDEL  in  the  program  listing  of  the  main 
quadruped  gait  program  (see  Section  A.  2)  should  be  replaced  by  subroutine 
POSTUR  given  below: 

C 

C  ***  SUBROUTINE  POSTUR  *** 

C 

DO  300  I  ■  1,  4 
AC(I)  »  0.0 
DAC(l)  =  0.0 
XLC(I)  »  ZR 
DLC(I)  -  0.0 
M(I)  -  .TRUE. 

300  XF(I)  »  HI (I) 

This  converts  the  program  to  a  quadruped  postural  system  simula¬ 
tion.  No  other  changes  are  necessary  for  obtaining  the  nonlinear  system 
response  to  the  different  vibrational  modes. 

This  quadruped  postural  system  simulation  was  used  to  compute  the 
nonlinear  system  response  by  exciting  it  with  each  of  the  twelve  eigen¬ 
vectors  computed  from  the  linearized  quadruped  locomotion  system  modal 
matrices  using  subroutine  NSEVB?  The  nonlinear  system  response  to  an 
eigenvector  describing  one  of  the  x  axis  vibrational  modes  is  given  in 
'fable  6. 

A. 4  Linearized  System  Response  of  the  Quadruped  Locomotion  System 
Figure  23  is  the  main  computer  program  used  to  determine  tue 
linearized  system  for  the  quadruped  locomotion  system.  The  expressions 
derived  in  Chapter  IV  for  the  linearized  quadruped  system  (see  equations 
(4-59)  through  (4-79)),  are  used  to  compute  the  eigenvalues  and  eigen- 
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vectors  of  each  modal  matrix.  After  this,  the  linear  system  response  is 
computed  from  subroutine  LINEAR.  Figure  24  is  a  listing  of  subroutine 
LINEAR.  Table  5  gives  the  linear  system  response  for  one  of  the  x  axis 
vibrational  modes, 

A. 5  Inverted  Pendulum  System  Computer  Programs 

This  section  describes  the  programs  used  for  the  simulation  of 
the  inverted  pendulum  system.  Figure  25  is  a  listing  of  the  program  used 
to  compute  stabilizing  control  constants  for  the  small  motion  stability 
of  the  inverted  pendulum  system  with  the  mass  pivoted  a  distance  r  5*  0 
below  its  center  of  gravity.  This  program  uses  the  general  algorithm 
derived  in  Section  6.6.2.  The  program  allows  the  designer  to  select  the 
required  control  constants  to  satisfy  :he  Routh-Hurwitz  criterion. 

Figure  26  shows  the  listing  used  for  the  simulation  of  the  inver¬ 
ted  pendulum  system.  This  program  uses  the  nonlinear  system  equations 
describee  in  Section  3.4. 

For  the  PDP-9  computer,  this  program  should  be  used  with  the 
Macro  subroutine  PIC  for  CRT  display  purposes.  This  program  can  be  used 
with  any  digital  computer  if  the  necessary  modifications  are  made  to  take 
into  account  the  particular  display  package  used.  This  inverted  pendulum 
simulation  was  also  programmed  on  the  faster  PDP-10  computer  using  the 
display  package  DTSPL. 

A. 6  Quadruped  Pace  and  Biped  Walk  Programs 

For  the  simulation  of  the  quadruped  pace  and  a3.se  the  type  of 
biped  walk  considered  in  this  research,  the  main  quadruped  gait  program 
of  Section  A. 2  was  modified  as  follows. 


r>  n 
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C  FORTRAN  PROGRAM. 

C  PNOGAAH  Ill  FIND  THE-  EIGENVALUES  AND  EIGENVECTORS  OF  IH£  REAL  HQN- 
C  SYMMETRIC  MATRICES  DESCRIBING  THE  VARIOCS  VIBRATIONAL  NODES  OF  THE 
C  QUADRUPED  POSTURAL  SYSTEM.  THIS  PROGRAM  ALSO  COMPUTES  THE  "FREE 
C  MOTION"  OF  THE  LINEARIZED  SYSTEM. 

C  THE  MAIN  PROGRAM  USES  BODY  DIMENSIONS  AND  CONTROL  CONSTANTS  AS 
C  INPUTS  ANO  COMPUTES  THE  MOMENTS  OF  INERTIA  OF  THE  BODY  ALONG  THE 
C  X,  V.  Z  AXES.  THE  MODAL  MATRICES  ARE  THEN  COMPUTED.  MAIN  THEN 

C  C Ae.LS  SUBROUTINE  NSEVB  WHICH  COMPUTES  THE  EIGENVALUES  AND  THE 

C  CORRESPONDING  EIGENVECTORS  FOR  EACH  MODAL  MATRIX.  FINALLY,  THE 
C  LINEAR  SYSTEM  RESPONSE  IS  CCMPUTEO  FOR  EACH  EIGENVECTOR  BY 

C  SUBROUTINE  LINEAR. 

OIMENSION  A( 20,20) ,  ERI20),  EII20),  YRI20.20),  VI(20,20i, 

1EBN0I 20 t « VEND I 20 *20 I , B( 20 , 20 > 

DOUBLE  PRECISION  RES,  SR,  SI 
REAL  1XX, !VY*I22 ,MA,LC 
NNAX-20 
RE ADIS, 10)  MM 
10  FORMAT (13) 

LCOUNT-O 

15  IF(LCCUNT.EQ.MM)  GO  TO  3TC 
READ! 5,20)  AA,BB,C,LO,MA 
20  FORMAT I 8F10.A) 

COMPUTE  THE  MOMENTS  OF  INERTIA  FOR  A  RECTANGULAR  PRISM  WITH  SIDES 
2A,  26,  2C. 

1 XX* ( I MAY ( BB*SB*C*C1 1/3.01 
IYY*i (MA*(AA*AA*C*C)>/3.0> 

IZZ*I (MA*(AA*AA»8Q*BB))/3.0) 

WRITE  16, 30)  AA,  SB,  C,  LO,  MA,  IXX,  IYY,  IZZ 
30  FORMAT  I/L7X, •DIMENSIONS  OF  BODY*,//,*  A** ,F5.2,2X,*B«* ,F5. 2.2X, *C 
1"* ♦F5.2i2X,* LENGTH** ,F5.2,2X, ’MASS* • ,F5.2,  //17X,* MOMENTS  Of  INERT 
21A*  ,//5X,  *IXX«*  ,F7.4,2X,*  m«V7.L,2X,‘Ut*.,;fTi*./  i 
REAOC  5,A0)  M 
AO  FORMAT! IS) 

KOUNT  *0 

AS  t F(XOUNT.EQ.M)  GO  TO  360 

READI5,50)  CA,OCA,CB,OCB,CL,OCL,DCX,CY,DCY 
SO  FORMAT  18F10. A) 

WR!TE!6,60)  CA,OCA,CB,OCB ,CL,OCL,DCX,CY,OCY 
60  F QRMAT 1 / 1TX , • CONTROL  CONSTANTS* *//, *  CA** ,FlQa4,2X,*0CA«* ,F10.A,2X 

1,*CB**,FI0.A,2X, *OCB**,FIO.A,/,*  CL*»  rF10.A,2X, *OCL«* ,F10.A, IX, *0C 
2X-»,F10.A,3X,*CY**,F10.A,/,i6X,*OCY-«,F10.A,//) 

NCOUNT*! 

N*A 

C  COMPUTE  THE  SYSTEM  MATRIX  FOR  THE  X  *  MODE. 

Btl, l)*0.0 
Bll, 21-1.0 
B( 1,31-0.0 


?ir^s  23.  Main  Program  for  Computing  the  Modal  Matrices,  and 
the  Linear  System  Response  of  the  Quadruped 
Locomotion  System. 
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8(l,4)-0.0 

M2.J1  -  ( 32.2/LQL  - (A.QfCAl/ 1 «A*LC*LC) ) 

6(2,21  -  -((4.0«DCA)/(HA*L0*LU>)  ♦  ( (4.0*OCX) /{ HA«LO)  i 
8(2,31  -  ((32.2*0/10)  -  ( (4.0*(LO*C)*CA)/(MA*LO*LQ)  I 
6(2,4)  *  -( (4.0*(L3*C)*0tA)/(MA*L0*L0)> 

8(3,1)«0.0 

9(3,2)«0.0 

8(3*31-0.0 

8(3,41-1.0 

8(4*1)  -((32.2*MA*O/(I¥y*L0))  -  ( (4.Q*CA*(L0*C) )/( 1YY*LO*LOI ) 
8(4,2)  *  ((4.0*(LO»C)*OCX)'(IYY*LO) )  -  ( (4.0*(LO*C)*0CA)/( I VY*L0* 

non 

9(4,3)  -  -((4.0*(L0»C)*U0*C)*CA)/(  IYV*LO*LO))  ♦  ( ( 32.2*MA*C* (L0*C 
1) )/( IYY4LQ1 1  -  ( (4.0*AA*AA*CLJ/LYY) 

3(4,4)  >  -{ (4.0*(LO*C)*(LO*C)*OCA)/( IYY*LO*LO) )  -  ( (4.0*AA*AA*0CL ) 
l/{ IYY) ) 

WR1TE(6*70) 

70  FORMAT (3X,* *4 X-AXIS  TRANSLATIONAL  A  ROTATIONAL  MOOAL  MATRIX*** ♦//) 

CO  TO  1000 
900  NCOUNT-2 
N-4 

C  COMPUTE  THE  SYSTEM  MATRIX  FOR  THE  Y  -  MODE. 

8(1,1 )-0.0 
8(1,2)01.0 
81 itji-O.O 
8(1*81-0*0  -  .  .. 

8(2,1)  *  (32.2/10)  -  ( (4.G*C8)/(MA*L0*LQ)C  -  . (4.0*CY)/(MA*LO) ) 
8(2,2)  *  — ( (4.0*OCA)/(MA*L0*L0) )  -  ( (4.0*0CY)/(MA*L0) ) 

8(2,3)  — ((32.2*C)/LO)  ♦  ((4.0*(LO*C)*CB)/(MA*LO*LO) ) 

8(2,4)  *  ( (4.0*(LQ*C)*0CB)/(MA*LO*L0)) 

8(3, l)-0.0 
8(3,2>-0. 0 
6(3,3)-0.0 
8(3*41-1.0 

8(4,1)— ((32.2*MA*C)/(IXX*L0))  ♦  ( (4.0*CB*(L0*C> )/( 1XX*L0*L0) )  *  < 
1(4.0*ILQ*C)*CY)/(12X*LQ)1 

8(4,2)  -  ( (4.0*(L0*C)*DCY)/(IXX*L0) )  ♦  ( (4.0*<LO«X)*OCB) /( IXX*LO* 
110))  _  .  . . 

8(4,3)  «  -( (4.0*( LQ*C)*(L0*C)*C8)/( 1XX*L0*L0) )  *  (( 32.2*NA*C*(L0*C 
1 ) i/( IXX*LO) )  -  i 14.0*88* BRtCLl/LXX) 

8(4,4)  -  — ( (4.0*( LO+C )*(L0*C)*0C8) /( IXX*L0*L0) )  -  ( (4.0*BB»88*OCL ) 
1/UXX1) 

WRITE (6,30)  AA,  88,  C*  LO,  NA,  IXX,  IVY*  I2Z 

JCA*OCA«f.B*CCB*Cl.DCL,DCX*CY.DCY . ___ . 

MRITE(4,i00) 

100  FflRMATt3X*f**7^XIS.IJUliSLAIlCNAL  &  ROTATIONAL  MODAL  MATRIX***,//) 
CO  TO  1000 

800  NCQUMT-3  _ _ 


Figure  23 
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N-2 

C  COKPUIE  THE  SYSTEM  MATRIX  EG*  THE  TRWkSLAT IGNAL  L  -  AXIS  MODE. 
B(l,lt-0.0 
8(1,21-1.0 
8!2,1>  — (*.0*CL)/MA 
812*21— (*.0*QCL)/MA 

WRITE (8*301  AA,  88*  C»  LO,  MA*  IXX,  IVY*  122 
WRITE (6 *60)  CA*0CA*C8*0CB*Ci *OCi*OCX,CY*OCY 
WRITE (6* 130) 

130  FORMAT (8X****2-AX1S  TRANSLATIONAL  MQOAL  MATRIX****,'/) 

00  135  1  *  1,N 

135  MRIT£(6,210)  (8( 1* J) * J»l,N) 

GO  TO  220 
700  NC  CLINT -A 

N»2 

C  COMPUTE  THE  ROTATIONAL  2  -  AXIS  NODE. 

8(1* 11-0.0 
811*21-1.0 

8(2*1)  -  ( ( 32.2*MA*(AA*AA*BB*BB> )/( I22*LO) )  -  ( (*.0*( AA*AA*G8*8B* 
1BB*CA) )/( I22*L0*L0I 1 

8(2*2)— A.0*(8B*B8*0CA*AA*AA*0CB)/( I22*LO*LO) 

WRITE (6*30)  AA*  BD,  C*  LO*  MA*  IXX*  IVY*  122 
WR(TE(6*60)  CA«OCA,CB.CCB«CL*OCL  *OCX*CV  *OCY 
WRITE (6. 1701 

170  FORMAT (8X« 9 **2-AX:S  ROTATIONAL  MODAL  MATRIX*** *//) 

00  ITS  I  -  1*N 

175  WRITE(6,21Q)  (81 1  * J) * J-1*N) 

GO  TO  220 
1000  CONTINUE 

00  190  1  *  l*  N 

190  WRITE (6*200)  ( B( I  * J) . J«l,NI 

200  F0RiUYi*0***E13~61  _ 

210  FC8MAT(*0*,13X*ZF13.6t 

220  00  230  I  -1.  A 

00  230  J  -1,  A 
230  AII.J1  *  8(1. J) 

BIG  »  0.0 
00  2*0  3  *1*  A 
00  2*0  J  -1*  N 

2*0  BIG  *  AKAXL(&iC*A&Sl All .Jill 

CALL  NSEVa(A«NMAX*N'£R«Et*Vft»VIfE8N0*YBNDI 
WRITE (6.250) 

250  FORMAT! 1MC«16X» ‘COMPUTED  EIGENVALUES* «//) 

WRITE (6*2601 

260  FORMATdX.'NO**  *3X* 'REAL  PART* ,7X* • (MAC.  PART* ,6X,* ERROR  SOUND**/) 

00  270  I  -1*  N 

270  WRITE (6*280)  I*  ER(II«  EIUI*  EBNOdl 

280  FORMAT ( IX, 12*3 ( lX*F15c91 * /} 


Figure  23.  Continued 
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J 

00  310  J  -1«  N 
WRITE (6*290  I  J 

FORMAT I  /»  13X*  'COMPUTED  EIGENVECTOR  NO.*Mli/l 
WRITE (6 >300) 

FORMAT 1 13X» 'REAL  PART' ,7X,  *  IMAC.  PART' , AX’, 'ERROR  BOUNDS/) 
00  310  1  >1*  A 

WRITE  (6, 320)  VR(  1 1 JSVI  <1  •  J)  *  VBNOI I  ♦  J) 

FORMAT! IX t3( lXtF15.9) »/) 

RES-O.ODO 
DO  3*0  I*  1,  N 
00  3*0  J-  1»  N 

SR*- I VRI 1  »J)*ECl  J)-VHlf  J)*EIt  Jl  ) 
oI»- ( VR1 1 » J)*E 1 1 J)*ER<  J)*VI ( I« J) ) 

:jQ  330  K  «1.  N  - 

SR*SR*A! I »K1*VRI a» J) 

SI  *  SI  *  All.K)  *  V1IM1 
RES  *  OMAXltREStOSQRT! SR**2  ♦  SI**2>) 

RES* RES/BIG 
WRITE(6,350)  RES 

FORMAT  (// *1X  , '  LARGESI_R£S  USUAL*  SEi  5. 9»  ✓/ 1 
CALL  LINEARINtERtEItVRfV! ) 

GO  TO  !90a(S00t7OO).  NCCUNT 
KOUNT*KOUNT»1 
GO  TO  *5 
CONTINUE 
LCOUNT *LCCUNT ♦ 1 
GO  TO  15 
STOP 
END 

[ 

[ 

c 

[ 


I 

1 

I 

I 

I 
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SUBROUTINE  L » NEARIN -£R»£ l ,VR?V I ) 

DIMENSION  ERl 20! ,E l ( 20! , VR<20,201 t VI <20 ,20 l ,X (200,4 | , VI 200v4> , 
mnO),Ot2O,?OTf£!2C,70) 

DO  30  J*1,N 
00  30  K* 3 »N 
0! J»K!*0«l*VR< J»K) 

£<J,K)*0.1*V!!J,K) 

00  101  K*1 t N 
WRITE (6  ,49) 

FORMATUX,' EIGENVALUE*! 

WRITE  <6*50!  <ER<K),F1<K  I 

50  FORMAT (/, IX » *  ALPHA* *,f 12.7.3X, 'OMEGA* *,E 12. 7,/) 

WRITE<6,52)  K 

52  FORMAT!/, 16X, '0. 1*C0HPUTED  EIGENVECTOR  NC.»',Il»// »18X*'RcAL  PART* 
1,7X, * IMAG.  PART',/) 

WRITE <6,51!  <D(L,K) ,c ! L ,K I ,L*l ,N) 

51  FORMAT!  15X»E15»'T»2X»E15.4»/I 
WRITE (6,31 ) 

31  FORMAT!/, 22X, 'LINEAR  SYSTEM  RESPONSf',/1 

WRITE (6,35> 

35  F0RMATr31X,».»,/,l*»»TT*E',m,»X'  ,HX,  *X»  ,  14X,  «0*  ,  14X  , 'O' , 

1/IH*,45X.'-»,14X, •-',//) 

00  100  1*1,101 
00  100  J*!,N 
Tin  *  u-n/io.o 

DENVER  IK )*T (!) 

IFIDFN.GT.100.C1  GO  TO  TO I 

Ql-FXPIOENI 

02*CnS(EI (K )*T( l ! I 

03*SIN<F  I(XI*T(  HI 

A*01*Q2 

B-Ql*<32 

x(i,j?*a»o(  j,ki-b«et;i,kt 

100  Y!!,JI*8*0(J,KI^A»E(4,K) 

WRI TE (6, 104)  (T!HT,X|M,I»,XC«,2),X(M,3),X(M,A),M*1,101) 

104  FORMAT (F7,4,4FI5.9) 

101  CONTINUE 
RETURN 

FWO  ~ 


Figure  24.  Subroutine  LINEAR  -  Fortran  SuDroutine  for 

Computing  theLinear  Systea  Response  for  each 
Eigenvector  of  a  Modal  Matrix  of  the  Quadruped 
Postural  Systea. 
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c  Fortran 

C  PROGRAM  TO  FIND  STABILIZING  CONTROL  CONSTANTS  FOR  AN 
C  INVERTED  PENDULUM  SYSTEM  WITH  THE  MASS  PIVOTED  BELOW  THE 

C  Tht  BODY,  »nD  HAVING  ONE  MASSLESS  LEG  OF  CONSTANT  LENGTH* 

C  SUPPORTED  BY  a  "  FIXED  "  FOOT. 

C  XM  *  MASS  OF  T«L  BODY 

C  XL  *  LEG  LENGTH 

C  XR  s  DISTANCE  of  the  body  CENTER  OF  GRAVITY  ABOVE  the  pivot 

c  xi  «  moment  of  inertia  of  the  body 

C  XKl  THROUGH  XK4  «  control  constants 

c  Rp  THROUGH  P6  *  ROUTH  COEFFICIENTS 

C  XI  *  angle  ^f  LEG  TO  the  vertical 

c  X2  «  angle  OF  BODY  (LONG  SIDE)  To  THE  HORIZONTAL 

C  GA Mh  A  *  R4  /  K2 

10  m'R  t t e ( 5 *  2r) 

format  ax, 2ih  tty  input  k*  l.  R»  I  > 

C *tL  ACC£P’( 4 t  XM#  XL*  XR*  Xt> 

WRITE(4,30)  XM.  XL.  XR,  XI 
30  F0KHAT(6XtlHM,7X,lHL*7X.lHR,7X.lHl/4X,4F7.3/> 

XA  «  XL  •  <VL  ♦  Xft) 

Xb  *  (Xl/X*-)  ♦  XR  •  XR  ♦  XL  •  X« 
xc  s  xA/Xg 

IF  (X&,tO.  •.*>)  GO  TO  52 
X-j  s  XL/XR 
wH  I T  E  (  4  »  4i  )  XU 
40  f  OH‘'AT<iX,a-L/H*/) 

52  CO"Ti,*.OL 

HR  I T  £  (  4  (  6C  ) 

fP  FORHATUX,«*.*/B  *»  F7.3/) 

kR  IT£{  4,  > 

72  FORMAT (62H  CHOOSE  GAMMA  $0  THAT  IT  IS  GREATER  THAN  A/0 
leut  LESS  T-AN  L/R/> 

MR  I  T£{  4  *  gi*  ) 

82  F0»**AT«2fcH  mhoOSE  GAMMA  ON  TTY  ) 

CALL  ACCEPT ( 4  *  GAMMA) 

HR  I Tt( 4*  92) 

9?  F0RMAT(34HURGUE»XKi*X2*XF2*»4AXK3*Xl*XK4»X3  > 

128  HR  I T£( 4.11/ ) 

lie  FORMAT ( 2ih  CHOOSE  K2,  K3  ON  TTY/) 

CALL  A CCE P T ( 4 ,  XK2,  XK3) 

XK4  «  GAMMA  »  X«2 

XE  »  (XK3/XC)  -  ( ( 32 •2*XK»XL*XL)/XC)  -  ( (.12, 2*XI *XL*XL* 
i(XL-XR*GAMMAj>/<xB*(XA«GAMMA-XB))> 

XF  «  ( XR*Xx^/XL)  -  32,2  •  XM  •  XR 
120  MR i T£( 4 » 13? ) 

138  FORMAT (1X,3hK2b*F10i4<4K  K3»,F10.4*4H  X4«,F10,4, 

14M  X£*,FiD.4,4H  xF»,F10,4/) 

HR  IT E( 4 i 142) 

14#  format <44h  choose  ki  less  than  xe»  but  greater  than  xf/> 

CALL  ACCEPT ( 4,  XKl) 

R0  »  xt  *  >L  •  XL 

R1  •  XA  •  XK4  •  XD  •  XK2 

R2  *  XA  •  <XK3  -  XM  •  XL  *32,2)  -  XB  «■  XKl 

R3  •  32,2  •  (XX2  •  XL  -  XK4  •  XR) 

R4  •  32,2  •  (32,2  •  XM  •  XR  •  XL  ♦  XKl  *  XL  -  XK3  •  XR) 

R5  ^  (<R1  •  R2  m  R»  •  R3)/»l) 


Figure  25.  Program  for  Computing  Stabilizing  Control  Constants 
for  the  Small  Motion  Stability  of  the  Inverted 
Pendulum  System. 
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150 

160 

vz 

183 


"* J It(*#l6/)  J^#  ,jg 

Sir?M1f;-^5/,ri0*3»5,,‘4Mw  *^10.3/) 

foJKJmJ7^  5K1*  Xk2‘  XK3‘  *m 

iJSiiiS;;;  k2  -*• . .  m  *,ria,4/> 

I?  «K? T°  CMANCC  K1#(K2*K3)» RESTART/) 

STOP 

6.NO 


i 

1 

I 

i 

5 


Figure  25.  Continued 
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C  FORTRAN 

C  Routine  TO  STABILIZE  A  SElF-TQROUING  INVESTED  PENDULUM 
c  w  11 H  THE  H»SS  P'.VOTEO  BELOW  THE  800V,  ANQ  HAVING  ONE  MASSLESS 
C  LEG  or  CONSTANT  length,  with  A  *  7IXE0  "  FOOT, 
c  This  program  uSas  the  euler-preqictor  corrector  method  or  ■ 
c  integration. 

c  THIS  PROGRAM  CAN  8E  USED  with  any  oigital  computer  provides 

C  THE  PROPER  Mp2;.:<:A?iohtS  ARE  HADE  TO  SUBROUTINE  PICTUR  CQRRE$» 

c  ponding  to  "nr  particular  oiplav  package  used. 

c  XH  *  MASS  OF  THE  BODY 

c  xl  *  length  or  the  leg 

C  XR  «  OISTAVCE  or  THE  CENTER  CE  GRAVITY  ABOVE  THE  PIVOT 
C  XI  *  MOMENT  OF  INERTIA  Or  THE  9C0V 

C  XKi,  XX2 *  **3,  XK4  *  CONTROL  CONSTANTS 

c  <i  *  angle  of  leg  to  the  vertical 

t  X2  s  ANC-LE  of  THE  800V (LONG  SI0E5  TO  TH£  HORIZONTAL 

c  ixi.in  «  fTxEP  DISPLAY  COORDINATES  OF  Tm£  FOOT 

L  OIAG  a  IP2  OF  BODY  DIAGONAL  (FT)  •  SCALE  FACTOR  «l/2*FTs40,0 
C  TKFTa  t  ANCLE  OF  BODY  DIAGONAL  TO  BODY  LONG  SIDE 
LOGICAL  NOCRT.  LOOP,  hEAONC 

OtKINSION  x<>(4).  X(4),  OXC 4) ,  IX{8>*  TITLE<4),  A(6>. 

t  C 1 3  I j  XX{4) 

COMMON  T0Rk.a1,*2. A3,A4,A5,A6,C1,C2»C3,0X1,0X2,3X3,0X4 
COH*»Oh/INP<it/oI  AG,  TwETA,  XH*Xl ,  XL  »XR,CT  ,PT,  TEND  .CRT  INC, 
lXM,**2,XK3,3K4,Xi,X2, X3,X4»  TITLE 1,T l TLE2»  TITLES, TITLE* 
EQUIVALENCE  ix«l  >.XU,lOX{Jl,DXi  ),  «t1tLE<1  I.TITlEi  ) 

Emit  YALt'.C'  (l  r.t  1),  I  xt)»  (I  VI  ),(XKil),XKl),<A<l>,  All 

l.(Cll)tCl) 

oat*  M£AONG/.f ALSE,/. IXi,!Yl/255,Sa/,X0NE/log/ 

u?r  *  i  ad"-;  title  an 

IBP  lF(HEApNG)  GO  TO  110 
h£*CNG  *  .  TfcilE  « 

IIP  »R  JT£{  4<  i2  <* t 

120  FORMAT  (1.T,  ?4H  tty  input  01  AG.,  THE  TA*  > 

CALt.  ACCEPT  i4,3IAG. THETA) 

Wfi  IT  £<  4*13.') 

i3p  fOPH*:<28w  ytv  input  k*i  for  new  title  > 

CALL  ACCEPT { 4, X) 
iMK.ca.ei  gc  to  i5P 
HE*D(4,14P>  title 
140  FORMAT (4*5) 

150  CONTINUE 

wfi !T£(4»16r) 

163  FOR)' AT (IX, 7,'HMASSr  INERTIA, LEG  LENGTH, LENGTH  XR,  CALCJNC, 

1  PRINTING*  tNOTlHE,  CRTINC/) 

CALL  ACCEPT<4,  XH,  XI,  XL,  XR,  CT.  PT,  TENO,  CRTINC) 
hR  JT  E  ( 6*  1?.:  >  XH»  XI*  XL*  XR*  CT*  PT*  TEND*  CRTINC 
17P  FORMATax*FA»l*2X,r5,i,4X*r5.1*0X»F5.1*5X*F5,l*4X,r7.4*3X,F5»J.* 

1  4X,F6.3/> 

IF  (CRTINC)  180*  190.  19i 
180  CRTINC  s  -  CRTINC 
NOC»T  «  .false* 

CO  TO  200 

1«8  NOCRT  «  .TRUE, 

200  WR!TE<4*217> 

210  FORM AT<1X,  17HC0NTR0L  CONSTANT*/) 


Figure  26.  Mein  Progrca  for  the  Nonlinear  Inserted 
Pendulua  System  Simulations 
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CALI  ACC£PT(4,XKl,XK2,XKJ#Xf'.4> 

TE<6»22/1  XKlf  XX2,  X*3,  XK4 
228  FGPPA?<tX,4<U.>f  18, 3>/? 

238  HnjT£(4.2«i} 

240  FORM AY  { iX ,  2,‘KJ  NS  T  J  At,  STATE  VECTOR/) 

CALL  ACCtPY  {4,  xi,  X2,  *3,  X4 ) 
hf?!TE<*,25:)  Xl»  x2,  *3,  X* 

2^8  FORMAT (lx, «Fi8.4/i 
WR1T£U»26.') 

248  . fGfiPAT <2X»4w|iMf » 13X, 12HST A?c  VECT0R»i6X,6HT0RQUE/l5X, 

12MX*-#7X,2hX?,8X,2HX3#8X,2)iS4/) 

C 

{.  ♦••FIRST  )<ALF  OF  7WE  {*1n  PROGRAM*** 

c 

?!"£  »  &,v 
PT I  ME  r  »0..r0?0l 
TO  «  -0{c8.-.'l 
LOOP  «  .  TP i <£  , 

270  TO«x  *  XK1SX2  *  XK2«X4  ♦  XK3*51  *  XK<aX3 
tl  *  XX  »  XL  *  XL 

k'i  «  XP  »  XL  a  XR  a  COSIX1  -X?) 

A3  *  X*  s  xt  #  Xfi  s  SiMXi  «X2> 

A4  *  32,2  *  Xh  *  XL  s  S|*J<X1) 

A5  *  32,2  «  X«  •  XR  r  $*NcX2) 

Aft  a  {Xf  «  xn  *  Xfc  o  xR? 

Cl  5  (A*  »  A3  *  X4  *  X4  ~  T0R«) 

C2  *  JA5  *  a3  *  X3  *  x5  ♦  TQRk) 

C3  *  CAl  *  Aft  -  A2  *  A2> 

0X1  *  X3 
0X2  »  x4 

0X3  *  <(A0  «  Cl  "  *2  *  C2)/C3> 

0X4  3  {Cjfci  *  C2  «  A2  •  C 1 > / C 3 : 

5F  i  LOOP  5  Gf  TC  3?0 
LOOP  «  ,T»t E. 

00  206*  1  t  t,  4 

2»9  X  <  I  *•  «  <  x  *  I J  ♦  DxU)  •  CT  *  xS(l))/2,0 

IFfTlHE  -  tf)  320,  298,  293 
PV2  ?0  a  TO  .  CRTINC 
C 

C  *e*SU8«0UTlM  FlCTUpo** 

C 

XX  *  X2  <  t«iE7A 
V  a  X2  -  Th£T* 

!AL  S  0 1  AG  •  COS! XX) 
i8L  *  0|AG  '  COS(T) 

ICl  *  OUG  •  5 2 N ( x x ) 

IOL  a  01  AG  *  SlM7» 

IX?  a  1ST(oXL  -  SUM XI)  •  40,8)  ♦  JXl 

1»2  «  !►-?<  Xj_  *  C03CXU  •  40,8)  ♦  m 

1X3  «  IM?-XR  *  SIN1X2)  •  48  0>  ♦  JX2 

IY3  a  I«T(  XH  *  C0S(X2)  •  49.0)  *  1Y? 

1X4  s  !*L  ♦  IS? 

*Y4  a  ICL  «■  !Y»V 
1X5  *  1BL  4  1X3 
!Y5  *  tOL  ♦  1Y3 
1X6  «  -JAL  ♦  JX? 

IY0  *  -ICL  ♦  1 Y3 


Figure  26 
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1x7  *  -JBU  »  1^3 
| V7  *  »10L  ♦  1 73 
CALL  ERASE 

CALL  POINTS,  Wit  9) 

CALL  Ll*tU'*>  <90} 

CALL  PO'NTUXX.  irx,  0) 

CALL  Li'* <1X2,  IV2) 

CALL  L!NEU*$.  iY3i 
CaLL  POINT  ( J  X4*  1Y4,  0) 

CALL  LJNEUX5,  1Y5) 

CALL  llKiltlX6.  1X6) 

.-Alt  LIN£<IX7,  1  Y  7) 

CALI  L  1n£{  I  x  4,  t  Y4  ) 

C*LL  PO!';Y(;»>5.  23,  0) 

C*LL  SYHBOU  IaOR,  4) 

CAUL  POlNT(.’f  400.  6) 

17  (NOCKT)  GO  To  320 

C 

C  •eoTiilr.GUK  AM'  AT  lr“N  CAMf RA*** 

C 


DO  295  1st,  6? 

293 

*0  =  XONt  °®  2 
call  on 

00  3?L  l  *  1,  70 

S?  P 

X-J  11  xO.'iE  »«  2 
C*LL  Off 

00  3  It  I  *  t»  1*33 

310 

XO  a  XONc  •*  2 

320 

CO NT INUE 

C 

C  **«  SECOND  **1?  OE  TkE  HaJN  PROGRAM*** 

C 

330  >f  t T I H£  -  PTI*i)  360,  34g.  340 
34?  ?T!*E  *  “Tl-.E  ♦  f~ 

oRiTE<6,35')  TIME.  XI.  X2»  X3.  X*.  YORK 
350  roRMAT<lX,r5.?.3X,4Fie,6,3X,riB,5> 

36S  ;f  (TIME  -  T£nU>  2/0,  270,  39g 
37,'  LOOP  *  ,f*LSE. 

do  see  i  *  j.  * 

xS<  I  >  »  x<I) 

380  X<1>  *  XS<1>  *  OX(I)  •  CT 

TIME  «  TIk£  ♦  CT 
CO  TO  270 
3«8  '-RiTE<4»480) 

*eg  Fv.qpAT<lX,«5M00  YOU  MJSH  TO  CHARGE  ANY  PHYSICAL  CONSTANTS?  ) 
CALL  ACCEPT  <4,  X A  5  ■ 

IE  (XA  , EG .  l.B)  GO  TO  110 
wR!T£U,41l’) 

«1S  F0RHAY<1X,4AH0Q  YOU  NISH  TO  CHANGE  ANY  CONTROL  CONSTANTS?  ) 
CALL  ACCEPT (4,  XB> 

IE  (XG  ,CO.  1.0)  GO  TO  200 

GO  TO  230 

STOP 

ENO 


Figure  26.  Continued 
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The  expression  for  the  lateral  control  torque  TS(I)  in  subroutine 
CONTRL  corresponding  to  equation  (6-111)  was  replaced  by  the  expression 

TS(I)  »  XK3  *  X8  +  XK4  *  B(I)  +  XK8  *  (X8+B(I)>  +•  XK9  *  (XlO-fDiJ(I)) 

corresponding  to  equation  (6-114) , 

In  addition,  the  subroutine  PICTUR  was  appropriately  modified  to 
display  the  quadruped  pace  and  the  biped  walk  as  shown  in  Figures  19  and 
20  respectively.  The  values  of  the  control  constants  K^,  K^,  Kg,  and 
were  obtained  by  taking  one  half  of  the  values  of  the  stabilizing  controv 
constants  through  obtained  by  applying  the  inverted  pendulum  Routh- 
Hurwitz  analysis  algorithm  to  the  body  in  its  lateral  (y-z)  plane. 
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